123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000 |
- #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:
- h_x0=RadarData-plevel[4].Level_Cal_zero;
- plevel[4].Level_Data1 = h_x0;
- if(h_x0<(-0.5f))
- h_x0 = (-0.5f);
- break;
-
- default:
- // f000=RadarData-offset[0];
-
- break;
- }
- H_x=(uint16_t)(h_x0*1000);
- for(Indexs=0;Indexs<=200;Indexs++)
- {
- if(H_x>HArray[Indexs]&&H_x<=HArray[Indexs+1])
- {
- V_y1 = VolArray[Indexs];
- V_y2 = VolArray[Indexs+1];
- H_x1 = HArray[Indexs];
- H_x2 = HArray[Indexs+1];
- __NOP();
- break;
- }
- }
- if(H_x<=0)
- {
- V_y1 = 0;
- V_y2 = 0;
- H_x1 = 0;
- H_x2 = 0;
- H_x = 0;
- }
- 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;
-
- }
|