collect/Core/Src/level.c

#include "stdint.h"
#include "cang.h"
#include "stdint.h"
#include "string.h"
#include "stdio.h"
#include "usart.h"
#include "config.h"
#include "rkg.h"
#include "cang.h"
#include "kzq.h"
#include "level.h"
#include "tem.h"
#include "angle.h"
#include "xyf.h"
#include "main.h"


Level_Inf level_inf[SENSOR_DEEP];



#define PI 3.1415926

#define Buffer_Size 20




//static uint16 oil_densit[30] =                          //平均密度
//{720,720,725,725,737,737,753,                           //汽油： 89、90、92、93、95、97、98
// 830,835,840,830,820,820,850,870,};                     //柴油： 5、0、-10、-20、-30、-35、10、20
//
//static float oil_coe[30]=
//{0.85,0.85,0.85,0.85,0.83,0.83,0.80,                       //温度，密度系数表
// 0.69,0.69,0.68,0.69,0.70,0.70,0.67,0.65,
//};

//static uint16_t level_up[8] = {1903,2059,2122,2106,2096,

//};

//static uint16_t level_low[8] = {1238,1419,1382,1441,1371,

//};


// 1-N仓罐容表

const uint16_t H_1cang[200] = {
0,
1293,
1296,
1299,
1302,
1305,
1308,
1311,
1314,
1317,
1320,
1323,
1326,
1329,
1331,
1334,
1337,
1340,
1343,
1346,
1349,
1352,
1355,
1358,
1361,
1364,
1367,
1370,
1373,
1376,
1379,
1382,
1385,
1388,
1391,
1394,
1397,
1400,
1403,
1406,
1409,
1412,
1415,
1418,
1421,
1424,
1427,
1430,
1434,
1437,
1440,
1443,
1446,
1449,
1452,
1455,
1458,
1462,
1465,
1468,
1471,
1474,
1477,
1480,
1484,
1487,
1490,
1493,
1496,
1499,
1503,
1506,
1509,
1512,
1515,
1519,
1522,
1525,
1528,
1531,
1535,
1538,
1541,
1544,
1548,
1551,
1554,
1557,
1560,
1564,
1567,
1570,
1573,
1577,
1580,
1583,
1587,
1590,
1593,
1596,
1600,
1603,
1606,
1610,
1613,
1616,
1619,
1623,
1626,
1630,
1633,
1636,
1640,
1643,
1647,
1650,
1654,
1657,
1661,
1665,
1668,
1672,
1675,
1679,
1683,
1686,
1690,
1694,
1697,
1701,
1705,
1709,
1712,
1716,
1720,
1724,
1728,
1731,
1735,
1739,
1743,
1747,
1751,
1755,
1759,
1763,
1768,
1772,
1776,
1780,
1785,
1789,
1793,
1798,
1802,
1807,
1812,
1817,
1821,
1827,
1832,
1837,
1843,
1849,
1855,
1861,	
};
const uint16_t H_2cang[200] = {
0,
1314,
1317,
1320,
1323,
1326,
1329,
1332,
1335,
1338,
1341,
1344,
1347,
1350,
1353,
1356,
1359,
1362,
1365,
1368,
1371,
1374,
1377,
1380,
1383,
1386,
1389,
1392,
1395,
1398,
1401,
1404,
1407,
1410,
1413,
1416,
1419,
1422,
1426,
1429,
1432,
1435,
1438,
1441,
1444,
1447,
1450,
1453,
1456,
1460,
1463,
1466,
1469,
1472,
1475,
1478,
1482,
1485,
1488,
1491,
1494,
1497,
1501,
1504,
1507,
1510,
1513,
1517,
1520,
1523,
1526,
1530,
1533,
1536,
1539,
1542,
1546,
1549,
1552,
1555,
1559,
1562,
1565,
1569,
1572,
1575,
1578,
1582,
1585,
1588,
1592,
1595,
1598,
1602,
1605,
1608,
1612,
1615,
1618,
1622,
1625,
1628,
1632,
1635,
1639,
1642,
1645,
1649,
1652,
1656,
1659,
1663,
1667,
1670,
1674,
1677,
1681,
1685,
1688,
1692,
1696,
1700,
1703,
1707,
1711,
1715,
1719,
1723,
1727,
1730,
1734,
1738,
1742,
1747,
1751,
1755,
1759,
1763,
1767,
1771,
1776,
1780,
1785,
1789,
1793,
1798,
1803,
1807,
1812,
1817,
1821,
1826,
1831,
1835,
1840,
1846,
1851,
1857,
1864,
1870,
1877,	
};
const uint16_t H_3cang[200] = {
0,
1292,
1295,
1298,
1301,
1304,
1307,
1310,
1313,
1316,
1319,
1321,
1324,
1327,
1330,
1333,
1336,
1339,
1342,
1345,
1348,
1351,
1354,
1357,
1360,
1363,
1366,
1369,
1372,
1375,
1378,
1381,
1384,
1387,
1390,
1393,
1396,
1399,
1402,
1405,
1408,
1411,
1414,
1417,
1420,
1424,
1427,
1430,
1433,
1436,
1439,
1442,
1445,
1448,
1451,
1454,
1457,
1460,
1464,
1467,
1470,
1473,
1476,
1479,
1482,
1485,
1488,
1492,
1495,
1498,
1501,
1504,
1507,
1510,
1514,
1517,
1520,
1523,
1526,
1530,
1533,
1536,
1539,
1542,
1546,
1549,
1552,
1555,
1559,
1562,
1565,
1568,
1572,
1575,
1578,
1582,
1585,
1588,
1591,
1595,
1598,
1601,
1605,
1608,
1611,
1615,
1618,
1622,
1625,
1629,
1632,
1636,
1639,
1643,
1646,
1650,
1653,
1657,
1660,
1664,
1668,
1671,
1675,
1679,
1683,
1686,
1690,
1694,
1698,
1702,
1705,
1709,
1713,
1717,
1721,
1725,
1729,
1732,
1736,
1740,
1744,
1748,
1752,
1757,
1761,
1765,
1769,
1773,
1778,
1782,
1787,
1791,
1796,
1800,
1805,
1810,
1815,
1820,
1825,
1830,
1835,
1841,
1846,
1852,
1857,
1863,	
};
const uint16_t H_4cang[200] = {
0,
1304,
1307,
1310,
1313,
1316,
1318,
1321,
1324,
1327,
1330,
1333,
1336,
1339,
1342,
1345,
1348,
1350,
1353,
1356,
1359,
1362,
1365,
1368,
1371,
1374,
1377,
1380,
1383,
1386,
1389,
1392,
1395,
1398,
1401,
1404,
1407,
1410,
1413,
1416,
1419,
1422,
1425,
1428,
1431,
1434,
1437,
1440,
1444,
1447,
1450,
1453,
1456,
1459,
1462,
1465,
1468,
1471,
1475,
1478,
1481,
1484,
1487,
1490,
1494,
1497,
1500,
1503,
1506,
1509,
1513,
1516,
1519,
1522,
1526,
1529,
1532,
1535,
1539,
1542,
1545,
1548,
1552,
1555,
1558,
1562,
1565,
1568,
1572,
1575,
1578,
1582,
1585,
1588,
1592,
1595,
1599,
1602,
1605,
1609,
1612,
1616,
1619,
1623,
1626,
1630,
1633,
1637,
1640,
1644,
1647,
1651,
1655,
1658,
1662,
1666,
1669,
1673,
1677,
1680,
1684,
1688,
1692,
1696,
1699,
1703,
1707,
1711,
1715,
1719,
1723,
1727,
1731,
1735,
1739,
1743,
1747,
1751,
1756,
1760,
1764,
1769,
1773,
1778,
1782,
1787,
1791,
1796,
1801,
1805,
1810,
1815,
1820,
1825,
1830,
1835,
1840,
1846,
1851,
1857,
1863,	
};
uint16_t Volume_1cang[200] = {
0,
8000,
8020,
8040,
8060,
8080,
8100,
8120,
8140,
8160,
8180,
8200,
8220,
8240,
8260,
8280,
8300,
8320,
8340,
8360,
8380,
8400,
8420,
8440,
8460,
8480,
8500,
8520,
8540,
8560,
8580,
8600,
8620,
8640,
8660,
8680,
8700,
8720,
8740,
8760,
8780,
8800,
8820,
8840,
8860,
8880,
8900,
8920,
8940,
8960,
8980,
9000,
9020,
9040,
9060,
9080,
9100,
9120,
9140,
9160,
9180,
9200,
9220,
9240,
9260,
9280,
9300,
9320,
9340,
9360,
9380,
9400,
9420,
9440,
9460,
9480,
9500,
9520,
9540,
9560,
9580,
9600,
9620,
9640,
9660,
9680,
9700,
9720,
9740,
9760,
9780,
9800,
9820,
9840,
9860,
9880,
9900,
9920,
9940,
9960,
9980,
10000,
10020,
10040,
10060,
10080,
10100,
10120,
10140,
10160,
10180,
10200,
10220,
10240,
10260,
10280,
10300,
10320,
10340,
10360,
10380,
10400,
10420,
10440,
10460,
10480,
10500,
10520,
10540,
10560,
10580,
10600,
10620,
10640,
10660,
10680,
10700,
10720,
10740,
10760,
10780,
10800,
10820,
10840,
10860,
10880,
10900,
10920,
10940,
10960,
10980,
11000,
11020,
11040,
11060,
11080,
11100,
11120,
11140,
11160,
11180,
11200,
11220,
11240,
11260,
11280,
};

uint16_t Volume_2cang[200] = {
0,
8000,
8020,
8040,
8060,
8080,
8100,
8120,
8140,
8160,
8180,
8200,
8220,
8240,
8260,
8280,
8300,
8320,
8340,
8360,
8380,
8400,
8420,
8440,
8460,
8480,
8500,
8520,
8540,
8560,
8580,
8600,
8620,
8640,
8660,
8680,
8700,
8720,
8740,
8760,
8780,
8800,
8820,
8840,
8860,
8880,
8900,
8920,
8940,
8960,
8980,
9000,
9020,
9040,
9060,
9080,
9100,
9120,
9140,
9160,
9180,
9200,
9220,
9240,
9260,
9280,
9300,
9320,
9340,
9360,
9380,
9400,
9420,
9440,
9460,
9480,
9500,
9520,
9540,
9560,
9580,
9600,
9620,
9640,
9660,
9680,
9700,
9720,
9740,
9760,
9780,
9800,
9820,
9840,
9860,
9880,
9900,
9920,
9940,
9960,
9980,
10000,
10020,
10040,
10060,
10080,
10100,
10120,
10140,
10160,
10180,
10200,
10220,
10240,
10260,
10280,
10300,
10320,
10340,
10360,
10380,
10400,
10420,
10440,
10460,
10480,
10500,
10520,
10540,
10560,
10580,
10600,
10620,
10640,
10660,
10680,
10700,
10720,
10740,
10760,
10780,
10800,
10820,
10840,
10860,
10880,
10900,
10920,
10940,
10960,
10980,
11000,
11020,
11040,
11060,
11080,
11100,
11120,
11140,
11160,
11180,
};

uint16_t Volume_3cang[200] = {
0,
8000,
8020,
8040,
8060,
8080,
8100,
8120,
8140,
8160,
8180,
8200,
8220,
8240,
8260,
8280,
8300,
8320,
8340,
8360,
8380,
8400,
8420,
8440,
8460,
8480,
8500,
8520,
8540,
8560,
8580,
8600,
8620,
8640,
8660,
8680,
8700,
8720,
8740,
8760,
8780,
8800,
8820,
8840,
8860,
8880,
8900,
8920,
8940,
8960,
8980,
9000,
9020,
9040,
9060,
9080,
9100,
9120,
9140,
9160,
9180,
9200,
9220,
9240,
9260,
9280,
9300,
9320,
9340,
9360,
9380,
9400,
9420,
9440,
9460,
9480,
9500,
9520,
9540,
9560,
9580,
9600,
9620,
9640,
9660,
9680,
9700,
9720,
9740,
9760,
9780,
9800,
9820,
9840,
9860,
9880,
9900,
9920,
9940,
9960,
9980,
10000,
10020,
10040,
10060,
10080,
10100,
10120,
10140,
10160,
10180,
10200,
10220,
10240,
10260,
10280,
10300,
10320,
10340,
10360,
10380,
10400,
10420,
10440,
10460,
10480,
10500,
10520,
10540,
10560,
10580,
10600,
10620,
10640,
10660,
10680,
10700,
10720,
10740,
10760,
10780,
10800,
10820,
10840,
10860,
10880,
10900,
10920,
10940,
10960,
10980,
11000,
11020,
11040,
11060,
11080,
11100,
11120,
11140,
11160,
11180,
11200,
11220,
11240,
11260,
11280,

};

uint16_t Volume_4cang[200] = {
0,
8000,
8020,
8040,
8060,
8080,
8100,
8120,
8140,
8160,
8180,
8200,
8220,
8240,
8260,
8280,
8300,
8320,
8340,
8360,
8380,
8400,
8420,
8440,
8460,
8480,
8500,
8520,
8540,
8560,
8580,
8600,
8620,
8640,
8660,
8680,
8700,
8720,
8740,
8760,
8780,
8800,
8820,
8840,
8860,
8880,
8900,
8920,
8940,
8960,
8980,
9000,
9020,
9040,
9060,
9080,
9100,
9120,
9140,
9160,
9180,
9200,
9220,
9240,
9260,
9280,
9300,
9320,
9340,
9360,
9380,
9400,
9420,
9440,
9460,
9480,
9500,
9520,
9540,
9560,
9580,
9600,
9620,
9640,
9660,
9680,
9700,
9720,
9740,
9760,
9780,
9800,
9820,
9840,
9860,
9880,
9900,
9920,
9940,
9960,
9980,
10000,
10020,
10040,
10060,
10080,
10100,
10120,
10140,
10160,
10180,
10200,
10220,
10240,
10260,
10280,
10300,
10320,
10340,
10360,
10380,
10400,
10420,
10440,
10460,
10480,
10500,
10520,
10540,
10560,
10580,
10600,
10620,
10640,
10660,
10680,
10700,
10720,
10740,
10760,
10780,
10800,
10820,
10840,
10860,
10880,
10900,
10920,
10940,
10960,
10980,
11000,
11020,
11040,
11060,
11080,
11100,
11120,
11140,
11160,
11180,

};

static uint16_t Inital_value_Low[4]= {1040,1040,1040,920};
static uint16_t Inital_value_High[4]= {1865,1880,1880,1880};


#define  TankH1    1.832
#define  TankH2    1.832
#define  TankH3    1.832
#define  TankH4    1.832
#define  TankH5    1.832
#define  TankH6    1.832
#define  TankH7    1.832
#define  TankH8    1.832
#include"math.h"

	int idxLow = 0;

static float h_x0;
//信捷罐容查表计计算程序  邵磊明  增加
float Calc_Vol(float RadarData, uint16_t *VolArray, const uint16_t *HArray, uint16_t StoreNum)
{
//	float offset[8];
//	uint8_t i = 0;
	Level_Inf *plevel = level_inf;
	static uint16_t Indexs = 0, Vt, H_x;
	static float V_y1 = 0, V_y2 = 0, H_x1 = 0, H_x2 = 0;
	////高度换算
	switch (StoreNum)
	{
	case 1:
		h_x0 = RadarData - plevel[1].Level_Cal_zero;
		plevel[1].Level_Data1 = h_x0;
		if (h_x0 < (-0.5f))
			h_x0 = (-0.5f);
		break;
	case 2:
		h_x0 = RadarData - plevel[2].Level_Cal_zero;
		plevel[2].Level_Data1 = h_x0;
		if (h_x0 < (-0.5f))
			h_x0 = (-0.5f);
		break;
	case 3:
		h_x0 = RadarData - plevel[3].Level_Cal_zero;
		plevel[3].Level_Data1 = h_x0;
		if (h_x0 < (-0.5f))
			h_x0 = (-0.5f);
		break;
	case 4:
	default:
		h_x0 = RadarData - plevel[4].Level_Cal_zero;
		plevel[4].Level_Data1 = h_x0;
		if (h_x0 < (-0.5f))
			h_x0 = (-0.5f);
		break;


	}

	H_x = (uint16_t)(h_x0 * 1000);

	for (Indexs = 0; Indexs <= 160; Indexs++)
	{
		if((HArray[Indexs]>HArray[Indexs + 1]) || (HArray[Indexs + 1]==0))
			break;
		V_y1 = VolArray[Indexs];
		V_y2 = VolArray[Indexs + 1];
		H_x1 = HArray[Indexs];
		H_x2 = HArray[Indexs + 1];
		if (H_x > HArray[Indexs] && H_x <= HArray[Indexs + 1])
		{
			break;
		}
	}
	if((Indexs>=160)||(HArray[Indexs]>HArray[Indexs + 1]) || (HArray[Indexs + 1]==0))
	{
		H_x=H_x2;
	}
	if (H_x <= 0)
	{
		V_y1 = 0;
		V_y2 = 0;
		H_x1 = 0;
		H_x2 = 0;
		H_x = 0;
		Vt = 0;
	}
	else
		Vt = (H_x - H_x1) / (H_x2 - H_x1) * (V_y2 - V_y1) + V_y1;

	return Vt;
}

/************************************************************************
*函数名：Value_Manage
*输入：罐仓长轴、短轴、液位高度、长度
*输出：无
*作用：将标准椭圆柱的液体高度转换为液体体积
*作者：kdl                         时间：
*************************************************************************/
#define  CangH    1.832
float data=0;
	int Volume_yuwei = 0;
uint16_t Value_Manage(uint8_t Cang_Flag)
{
	int Volume_5mm = 0;

	Level_Inf* plevel = level_inf;
	
data = CangH - plevel[(Cang_Flag+1)].Level_Data+plevel[(Cang_Flag+1)].Level_Cal_zero;
	if(data == 65535)
		return 0;
	
	
	
	data = data/10;
	Volume_yuwei = (int)data%5;
	int Volume_Data = 0;
	switch(Cang_Flag)
	{
			case 0:
				  Flash_ReadBytes(Volume_1cang,ADD_CANG1_TABLE,200);
					if(data >= Inital_value_High[0])
							plevel[Cang_Flag].Volume_Data  = 10900;
					else if(data >= Inital_value_Low[0] && data < Inital_value_High[0])
					{
							Volume_5mm = (data - Inital_value_Low[0])/5;
							Volume_Data = Volume_1cang[Volume_5mm] + (Volume_1cang[Volume_5mm+1] - Volume_1cang[Volume_5mm])*Volume_yuwei/5;
					}
					else if(data >= (Inital_value_High[0]-Inital_value_Low[0]) && data< Inital_value_Low[0])
							Volume_Data= Volume_1cang[0] - (Inital_value_Low[0] - data)*7;
					else if(data < (Inital_value_High[0]-Inital_value_Low[0]) && data >=100)
					{
							Volume_5mm = ((Inital_value_High[0]-data) - Inital_value_Low[0])/5;
							Volume_Data =11116 - (Volume_1cang[Volume_5mm] + (Volume_1cang[Volume_5mm+1] - Volume_1cang[Volume_5mm])*Volume_yuwei/5);
					}
					else
							Volume_Data = 0;
					plevel[Cang_Flag].Volume_Data  = Volume_Data;//data*10*10000;
					break;
	
			case 1:
				  Flash_ReadBytes(Volume_2cang,ADD_CANG2_TABLE,200);				
					if(data >= Inital_value_High[1])
							plevel[Cang_Flag].Volume_Data  = 10900;
					else if(data >= Inital_value_Low[1] && data < Inital_value_High[1])
					{
							Volume_5mm = (data - Inital_value_Low[1])/5;
							Volume_Data = Volume_2cang[Volume_5mm] + (Volume_2cang[Volume_5mm+1] - Volume_2cang[Volume_5mm])*Volume_yuwei/5;
					}
					else if(data >= (Inital_value_High[1]-Inital_value_Low[1])&& data< Inital_value_Low[1])
							Volume_Data= Volume_2cang[0] - (Inital_value_Low[1] - data)*7;
					else if(data < (Inital_value_High[1]-Inital_value_Low[1]) && data >=100)
					{
							Volume_5mm = ((Inital_value_High[1]-data) - Inital_value_Low[1])/5;
							Volume_Data =11116 - (Volume_2cang[Volume_5mm] + (Volume_2cang[Volume_5mm+1] - Volume_2cang[Volume_5mm])*Volume_yuwei/5);
					}
					else
							Volume_Data = 0;
					plevel[Cang_Flag].Volume_Data = Volume_Data;//data*10*10000;
					break;
			case 2:
				  Flash_ReadBytes(Volume_3cang,ADD_CANG3_TABLE,200);					
					if(data >= Inital_value_High[2])
							plevel[Cang_Flag].Volume_Data = 10900;
					else if(data >= Inital_value_Low[2] && data < Inital_value_High[2])
					{
							Volume_5mm = (data - Inital_value_Low[2])/5;
							Volume_Data = Volume_3cang[Volume_5mm] + (Volume_3cang[Volume_5mm+1] - Volume_3cang[Volume_5mm])*Volume_yuwei/5;
					}
					else if(data >= (Inital_value_High[2]-Inital_value_Low[2]) && data< Inital_value_Low[0])
							Volume_Data= Volume_3cang[0] - (Inital_value_Low[2] - data)*7;
					else if(data < (Inital_value_High[2]-Inital_value_Low[2]) && data >=100)
					{
							Volume_5mm = ((Inital_value_High[2]-data) - Inital_value_Low[2])/5;
							Volume_Data =11116 - (Volume_3cang[Volume_5mm] + (Volume_3cang[Volume_5mm+1] - Volume_3cang[Volume_5mm])*Volume_yuwei/5);
					}
					else
							Volume_Data = 0;
				    	plevel[Cang_Flag].Volume_Data = Volume_Data;
					break;
			case 3:
				  Flash_ReadBytes(Volume_4cang,ADD_CANG3_TABLE,200);					
					if(data >= Inital_value_High[3])
							plevel[Cang_Flag].Volume_Data = 12700;
					else if(data >= Inital_value_Low[3] && data < Inital_value_High[3])
					{
							Volume_5mm = (data - Inital_value_Low[3])/5;
							Volume_Data = Volume_4cang[Volume_5mm] + (Volume_4cang[Volume_5mm+1] - Volume_4cang[Volume_5mm])*Volume_yuwei/5;
					}
					else if(data >= Inital_value_High[3]-Inital_value_Low[3] && data< Inital_value_Low[3])
							Volume_Data= Volume_4cang[0] - (Inital_value_Low[3] - data)*8;
					else if(data < Inital_value_High[3]-Inital_value_Low[3] && data >= 100)
					{
							Volume_5mm = ((Inital_value_High[3]-data) - Inital_value_Low[3])/5;
							Volume_Data =12850 - (Volume_4cang[Volume_5mm] + (Volume_4cang[Volume_5mm+1] - Volume_4cang[Volume_5mm])*Volume_yuwei/5);
					}
					else
							Volume_Data = 0;
					plevel[Cang_Flag].Volume_Data = Volume_Data;
					break;
	
			default:
					plevel[Cang_Flag].Volume_Data = 0xffff;
          break;
    }
	return 1;
}

/*
罐容表远程配置功能
功能增加：	邵磊明  
*/
uint16_t GRB_SET_Table(uint8_t* pTx)
{
	KZQ_Inf* pkzq = &kzq_inf;
//	Cang_Inf* pcang = &cang_inf;
//	Level_Inf* plevel = level_inf;Total_pag_num = 0,
	uint8_t i = 0;
  uint8_t 	Pag_num = 0,CP_CNT=0;
	uint16_t j=0;//ModBusCRC = 0,
//	uint8_t receive_error = 0;
//	uint16_t ModbusCRC = 0;                      
	uint16_t Cang_num = 0;
	uint16_t Flash_buf[20] = {0};
	uint16_t Flash_buf1[20] = {0};
	static uint16_t Pag_num_cnt = 0;
	for(i=0;i<20;i++)
  {				
	  Flash_buf[i]=(uint16_t)(pkzq->data_buf[i*2+20]<<8|pkzq->data_buf[i*2+21]);
	  Flash_buf1[i]=(uint16_t)(pkzq->data_buf[i*2+20]<<8|pkzq->data_buf[i*2+21]);		
  }
	if(pkzq->data_buf[7] == 0x06)
	{
			Cang_num = USART2_RX_BUF002[16];
			Cang_num = Cang_num << 8;
			Cang_num |= USART2_RX_BUF002[17];
	    //Total_pag_num = USART2_RX_BUF002[19];
	    Pag_num = USART2_RX_BUF002[18];
			if(Cang_num == 0x0001)
			{	
				if(Pag_num == 1)
				{
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        			
        }
        else if(Pag_num == 2)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+40,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+40,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==40)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        		       					
				}	
        else if(Pag_num == 3)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+80,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+80,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}		
        else if(Pag_num == 4)		
        {		
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+120,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+120,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        								
				}	
        else if(Pag_num == 5)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+160,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+160,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}	
        else if(Pag_num == 6)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+200,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+200,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        							
				}	
        else if(Pag_num == 7)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+240,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+240,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}		
        else if(Pag_num == 8)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+280,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+280,20);			
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}	
        else if(Pag_num == 9)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+320,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+320,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        				
				}		
        else if(Pag_num == 10)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG1_TABLE+360,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG1_TABLE+360,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;	
            Pag_num_cnt=0;						
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;						
						return 0;
					}
			
        				
				}					
			}
			else if(Cang_num == 0x0002)
			{
				if(Pag_num == 1)
				{
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        			
        }
        else if(Pag_num == 2)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+40,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+40,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==40)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        		       					
				}	
        else if(Pag_num == 3)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+80,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+80,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}		
        else if(Pag_num == 4)		
        {		
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+120,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+120,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        								
				}	
        else if(Pag_num == 5)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+160,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+160,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}	
        else if(Pag_num == 6)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+200,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+200,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        							
				}	
        else if(Pag_num == 7)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+240,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+240,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}		
        else if(Pag_num == 8)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+280,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+280,20);			
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}	
        else if(Pag_num == 9)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+320,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+320,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        				
				}		
        else if(Pag_num == 10)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG2_TABLE+360,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG2_TABLE+360,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;	
            Pag_num_cnt=0;						
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;						
						return 0;
					}
			
        				
				}		
			}
			else if(Cang_num == 0x0003)
			{
				if(Pag_num == 1)
				{
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        			
        }
        else if(Pag_num == 2)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+40,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+40,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==40)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        		       					
				}	
        else if(Pag_num == 3)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+80,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+80,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}		
        else if(Pag_num == 4)		
        {		
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+120,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+120,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        								
				}	
        else if(Pag_num == 5)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+160,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+160,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}	
        else if(Pag_num == 6)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+200,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+200,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        							
				}	
        else if(Pag_num == 7)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+240,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+240,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}		
        else if(Pag_num == 8)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+280,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+280,20);			
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}	
        else if(Pag_num == 9)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+320,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+320,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        				
				}		
        else if(Pag_num == 10)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG3_TABLE+360,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG3_TABLE+360,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;	
            Pag_num_cnt=0;						
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;						
						return 0;
					}
			
        				
				}			
			}	
			else if(Cang_num == 0x0004)
			{
				if(Pag_num == 1)
				{
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        			
        }
        else if(Pag_num == 2)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+40,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+40,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==40)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        		       					
				}	
        else if(Pag_num == 3)		
        {					
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+80,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+80,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}		
        else if(Pag_num == 4)		
        {		
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+120,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+120,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        								
				}	
        else if(Pag_num == 5)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+160,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+160,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        					
				}	
        else if(Pag_num == 6)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+200,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+200,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        							
				}	
        else if(Pag_num == 7)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+240,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+240,20);		
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}		
        else if(Pag_num == 8)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+280,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+280,20);			
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        						
				}	
        else if(Pag_num == 9)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+320,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+320,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;							
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;										
						return 0;
					}
			
        				
				}		
        else if(Pag_num == 10)		
        {
        Flash_WriteBytes(Flash_buf,ADD_CANG4_TABLE+360,20);		
        Flash_ReadBytes(Flash_buf,ADD_CANG4_TABLE+360,20);	
        for(j=0;j<20;j++)
        {
					if(Flash_buf1[j]==Flash_buf[j])
						CP_CNT++;
				}
					if(CP_CNT==20)
					{
						Pag_num_cnt++;
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];						
            if(Pag_num_cnt==10)		
						pTx[20] = 2;
            else
						pTx[20] = 1;	
            Pag_num_cnt=0;						
						return 1;
					}
					else
					{
						pTx[16] = USART2_RX_BUF002[16];
	          pTx[17] = USART2_RX_BUF002[17];
						pTx[18] = USART2_RX_BUF002[18];	
						pTx[19] = USART2_RX_BUF002[19];				
						pTx[20] = 0;						
						return 0;
					}
			
        				
				}				
			}		
	}
	
	
	return 0;
	
}