标签：des style blog io ar color os sp for
1 1 /******************************************************************************* 2 2 ******************************************************************************** 3 3 ** 4 4 ** File Name 5 5 ** --------- 6 6 ** 7 7 ** aplink.c 8 8 ** 9 9 ******************************************************************************** 10 11 12 1270 13 1271 /*------------------------------------------------------------------------------ 14 1272 ** aplink_RunCfgStateMachine() 15 1273 **------------------------------------------------------------------------------ 16 1274 */ 17 1275 18 1276 void aplink_RunCfgStateMachine( void ) 19 1277 { 20 1278 UTIL_BufMsgType* psQEntry; 21 1279 static UINT16 iMapCntr; 22 1280 static UINT16 iSingleEntrySize; 23 1281 UINT16* piTemp; 24 1282 25 1283 26 1284 switch( aplink_s.eCfgState ) 27 1285 { 28 1286 case APLINK_CFG_SM_INIT: 29 1287 /* 30 1288 ** Initialise variables etc. 31 1289 */ 32 1290 33 1291 aplink_s.psReadCfg = NULL; 34 1292 aplink_s.psWriteCfg = NULL; 35 1293 36 1294 aplink_s.iReadPdLength = 0; 37 1295 aplink_s.iWritePdLength = 0; 38 1296 39 1297 aplink_s.eCfgState = APLINK_CFG_SM_READ_MODULE_TYPE; 40 1298 41 1299 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_INIT." ); 42 1300 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_READ_MODULE_TYPE." ); 43 1301 44 1302 45 1303 break; /* End case APLINK_CFG_SM_INIT: */ 46 1304 47 1305 48 1306 case APLINK_CFG_SM_READ_MODULE_TYPE: 49 1307 /* 50 1308 ** Allocate a buffer. 51 1309 */ 52 1310 53 1311 psQEntry = UTIL_AllocateMsgBuffer( &APLINK_asCmdToAbccBuf[ 0 ], 54 1312 ABCC_NBR_SIMULTANEOUS_APPL_COMMANDS ); 55 1313 56 1314 if( psQEntry == NULL ) 57 1315 { 58 1316 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_OUT_OF_BUFFERS ); 59 1317 } 60 1318 61 1319 62 1320 /* 63 1321 ** Read the module type of the ABCC module. 64 1322 */ 65 1323 66 1324 psQEntry->sMsg.sHeader.bSourceId = (UINT8)0x01; 67 1325 psQEntry->sMsg.sHeader.bDestObj = (UINT8)ABP_OBJ_NUM_ANB; 68 1326 psQEntry->sMsg.sHeader.iInstance = 0x0001; 69 1327 psQEntry->sMsg.sHeader.bCmd = (UINT8)( ABP_CMD_GET_ATTR | ABP_MSG_HEADER_C_BIT ); 70 1328 psQEntry->sMsg.sHeader.bDataSize = (UINT8)0x00; 71 1329 psQEntry->sMsg.sHeader.bCmdExt0 = (UINT8)ABP_ANB_IA_MODULE_TYPE; 72 1330 psQEntry->sMsg.sHeader.bCmdExt1 = (UINT8)0x00; 73 1331 74 1332 /* 75 1333 ** Post the message to the ABCC. 76 1334 */ 77 1335 78 1336 (void)aplink_AddFragAndPostMsg( psQEntry ); 79 1337 80 1338 81 1339 /* 82 1340 ** Wait for the response. 83 1341 */ 84 1342 85 1343 aplink_s.eCfgState = APLINK_CFG_SM_WAIT_MODULE_TYPE_RSP; 86 1344 87 1345 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_WAIT_MODULE_TYPE_RSP." ); 88 1346 89 1347 break; /* End case APLINK_CFG_SM_READ_MODULE_TYPE */ 90 1348 91 1349 92 1350 case APLINK_CFG_SM_WAIT_MODULE_TYPE_RSP: 93 1351 /* 94 1352 ** Check if theres a new response for us. 95 1353 */ 96 1354 97 1355 if( UTIL_GetFirstMessageFromQueue( aplink_s.xMsgsFromAbccQueue, &psQEntry ) == UTIL_OK ) 98 1356 { 99 1357 /* 100 1358 ** Decrease the number of messages that are processing... 101 1359 */ 102 1360 103 1361 aplink_s.bNbrOfCmdsActiveToAbcc--; 104 1362 105 1363 106 1364 /* 107 1365 ** We have received a new message. 108 1366 */ 109 1367 110 1368 if( ( psQEntry->sMsg.sHeader.bSourceId == (UINT8)0x01 ) && 111 1369 ( psQEntry->sMsg.sHeader.bDestObj == (UINT8)ABP_OBJ_NUM_ANB ) && 112 1370 ( psQEntry->sMsg.sHeader.iInstance == 0x0001 ) && 113 1371 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_C_BIT ) ) ) && 114 1372 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_E_BIT ) ) ) && 115 1373 ( psQEntry->sMsg.sHeader.bDataSize == (UINT8)ABP_ANB_IA_MODULE_TYPE_DS ) && 116 1374 ( psQEntry->sMsg.sHeader.bCmdExt0 == (UINT8)ABP_ANB_IA_MODULE_TYPE ) && 117 1375 ( psQEntry->sMsg.sHeader.bCmdExt1 == (UINT8)0x00 ) ) 118 1376 { 119 1377 /* 120 1378 ** Response is OK. Read the data attached. 121 1379 */ 122 1380 123 1381 piTemp = (UINT16*)&psQEntry->sMsg.abData[ 0 ]; 124 1382 aplink_s.iModuleType = UTIL_WordToNative( *piTemp ); 125 1383 126 1384 ABCC_CbfDebugInfo( "APLINK/Configuration: Module type response received." ); 127 1385 128 1386 /* 129 1387 ** Read the network data-type. 130 1388 */ 131 1389 132 1390 aplink_s.eCfgState = APLINK_CFG_SM_READ_NW_TYPE; 133 1391 134 1392 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_READ_NW_TYPE." ); 135 1393 } 136 1394 else 137 1395 { 138 1396 /* 139 1397 ** There is some error in the response. 140 1398 */ 141 1399 142 1400 ABCC_CbfDebugInfo( "APLINK/Configuration: Module type error response." ); 143 1401 144 1402 /* 145 1403 ** Signal a fatal error to the application 146 1404 */ 147 1405 148 1406 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_INVALID_MODULE_TYPE_RECEIVED ); 149 1407 150 1408 /* 151 1409 ** Change driver state, so the applicaton is able to send a RESET 152 1410 */ 153 1411 154 1412 APLINK_ChangeDriverState( APLINK_SM_IN_RUN_NO_PD ); 155 1413 156 1414 } /* End ( Response is not OK? ) */ 157 1415 158 1416 /* 159 1417 ** Free the allocated buffer. 160 1418 */ 161 1419 162 1420 UTIL_FreeMsgBuffer( psQEntry ); 163 1421 164 1422 } /* End if( New message? ) */ 165 1423 166 1424 break; /* End case APLINK_CFG_SM_WAIT_MODULE_TYPE_RSP: */ 167 1425 168 1426 169 1427 case APLINK_CFG_SM_READ_NW_TYPE: 170 1428 /* 171 1429 ** Allocate a buffer. 172 1430 */ 173 1431 174 1432 psQEntry = UTIL_AllocateMsgBuffer( &APLINK_asCmdToAbccBuf[ 0 ], 175 1433 ABCC_NBR_SIMULTANEOUS_APPL_COMMANDS ); 176 1434 177 1435 if( psQEntry == NULL ) 178 1436 { 179 1437 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_OUT_OF_BUFFERS ); 180 1438 } 181 1439 182 1440 183 1441 /* 184 1442 ** Read the network type of the ABCC module. 185 1443 */ 186 1444 187 1445 psQEntry->sMsg.sHeader.bSourceId = (UINT8)0x01; 188 1446 psQEntry->sMsg.sHeader.bDestObj = (UINT8)ABP_OBJ_NUM_NW; 189 1447 psQEntry->sMsg.sHeader.iInstance = 0x0001; 190 1448 psQEntry->sMsg.sHeader.bCmd = (UINT8)( ABP_CMD_GET_ATTR | ABP_MSG_HEADER_C_BIT ); 191 1449 psQEntry->sMsg.sHeader.bDataSize = (UINT8)0x00; 192 1450 psQEntry->sMsg.sHeader.bCmdExt0 = (UINT8)ABP_NW_IA_NW_TYPE; 193 1451 psQEntry->sMsg.sHeader.bCmdExt1 = (UINT8)0x00; 194 1452 195 1453 196 1454 /* 197 1455 ** Post the message to the ABCC module. 198 1456 */ 199 1457 200 1458 (void)aplink_AddFragAndPostMsg( psQEntry ); 201 1459 202 1460 203 1461 /* 204 1462 ** Fetch the response. 205 1463 */ 206 1464 207 1465 aplink_s.eCfgState = APLINK_CFG_SM_READ_NW_TYPE_RSP; 208 1466 209 1467 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_READ_NW_TYPE_RSP." ); 210 1468 211 1469 break; /* End case APLINK_CFG_SM_READ_NW_TYPE: */ 212 1470 213 1471 214 1472 case APLINK_CFG_SM_READ_NW_TYPE_RSP: 215 1473 /* 216 1474 ** Check if theres a new response for us. 217 1475 */ 218 1476 219 1477 if( UTIL_GetFirstMessageFromQueue( aplink_s.xMsgsFromAbccQueue, &psQEntry ) == UTIL_OK ) 220 1478 { 221 1479 /* 222 1480 ** Decrease the number of messages that are processing... 223 1481 */ 224 1482 225 1483 aplink_s.bNbrOfCmdsActiveToAbcc--; 226 1484 227 1485 228 1486 /* 229 1487 ** We have received a new message. 230 1488 */ 231 1489 232 1490 if( ( psQEntry->sMsg.sHeader.bSourceId == (UINT8)0x01 ) && 233 1491 ( psQEntry->sMsg.sHeader.bDestObj == (UINT8)ABP_OBJ_NUM_NW ) && 234 1492 ( psQEntry->sMsg.sHeader.iInstance == 0x0001 ) && 235 1493 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_C_BIT ) ) ) && 236 1494 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_E_BIT ) ) ) && 237 1495 ( psQEntry->sMsg.sHeader.bDataSize == (UINT8)ABP_NW_IA_NW_TYPE_DS ) && 238 1496 ( psQEntry->sMsg.sHeader.bCmdExt0 == (UINT8)ABP_NW_IA_NW_TYPE ) && 239 1497 ( psQEntry->sMsg.sHeader.bCmdExt1 == (UINT8)0x00 ) ) 240 1498 { 241 1499 /* 242 1500 ** Response is OK. Read the data attached. 243 1501 */ 244 1502 245 1503 piTemp = (UINT16*)&psQEntry->sMsg.abData[ 0 ]; 246 1504 aplink_s.iNetworkType = UTIL_WordToNative( *piTemp ); 247 1505 // AT24CXX_WriteOneByte(10,aplink_s.iNetworkType);/* 引起死机 */ 248 1506 fsmc_sram_test_write(aplink_s.iNetworkType,2); 249 1507 250 1508 ABCC_CbfDebugInfo( "APLINK/Configuration: Network type response received." ); 251 1509 252 1510 253 1511 254 1512 /* 255 1513 ** Read the network parameter support. 256 1514 */ 257 1515 258 1516 aplink_s.eCfgState = APLINK_CFG_SM_READ_NW_PARAM_SUPPORT; 259 1517 260 1518 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_READ_NW_PARAM_SUPPORT." ); 261 1519 262 1520 } 263 1521 else 264 1522 { 265 1523 /* 266 1524 ** There is some error in the response. 267 1525 */ 268 1526 269 1527 ABCC_CbfDebugInfo( "APLINK/Configuration: Network Type error response." ); 270 1528 271 1529 /* 272 1530 ** Signal a fatal error to the application 273 1531 */ 274 1532 275 1533 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_INVALID_NETWORK_TYPE_RECEIVED ); 276 1534 277 1535 /* 278 1536 ** Change driver state, so the applicaton is able to send a RESET 279 1537 */ 280 1538 281 1539 APLINK_ChangeDriverState( APLINK_SM_IN_RUN_NO_PD ); 282 1540 283 1541 } /* End if( Response OK? ) */ 284 1542 285 1543 /* 286 1544 ** Free the allocated buffer. 287 1545 */ 288 1546 289 1547 UTIL_FreeMsgBuffer( psQEntry ); 290 1548 291 1549 } /* End if( New message? ) */ 292 1550 293 1551 294 1552 break; /* End case APLINK_CFG_SM_READ_NW_TYPE_RSP: */ 295 1553 296 1554 297 1555 case APLINK_CFG_SM_READ_NW_PARAM_SUPPORT: 298 1556 /* 299 1557 ** Allocate a buffer. 300 1558 */ 301 1559 302 1560 psQEntry = UTIL_AllocateMsgBuffer( &APLINK_asCmdToAbccBuf[ 0 ], 303 1561 ABCC_NBR_SIMULTANEOUS_APPL_COMMANDS ); 304 1562 305 1563 if( psQEntry == NULL ) 306 1564 { 307 1565 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_OUT_OF_BUFFERS ); 308 1566 } 309 1567 310 1568 311 1569 /* 312 1570 ** Read the network parameter support of the ABCC module. 313 1571 */ 314 1572 315 1573 psQEntry->sMsg.sHeader.bSourceId = (UINT8)0x01; 316 1574 psQEntry->sMsg.sHeader.bDestObj = (UINT8)ABP_OBJ_NUM_NW; 317 1575 psQEntry->sMsg.sHeader.iInstance = 0x0001; 318 1576 psQEntry->sMsg.sHeader.bCmd = (UINT8)( ABP_CMD_GET_ATTR | ABP_MSG_HEADER_C_BIT ); 319 1577 psQEntry->sMsg.sHeader.bDataSize = (UINT8)0x00; 320 1578 psQEntry->sMsg.sHeader.bCmdExt0 = (UINT8)ABP_NW_IA_PARAM_SUPPORT; 321 1579 psQEntry->sMsg.sHeader.bCmdExt1 = (UINT8)0x00; 322 1580 323 1581 324 1582 /* 325 1583 ** Post the message to the ABCC module. 326 1584 */ 327 1585 328 1586 (void)aplink_AddFragAndPostMsg( psQEntry ); 329 1587 330 1588 331 1589 /* 332 1590 ** Fetch the response. 333 1591 */ 334 1592 335 1593 aplink_s.eCfgState = APLINK_CFG_SM_READ_NW_PARAM_SUPPORT_RSP; 336 1594 337 1595 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_READ_NW_PARAM_SUPPORT_RSP." ); 338 1596 339 1597 break; /* End case APLINK_CFG_SM_READ_NW_PARAM_SUPPORT: */ 340 1598 341 1599 342 1600 case APLINK_CFG_SM_READ_NW_PARAM_SUPPORT_RSP: 343 1601 /* 344 1602 ** Check if theres a new response for us. 345 1603 */ 346 1604 347 1605 if( UTIL_GetFirstMessageFromQueue( aplink_s.xMsgsFromAbccQueue, &psQEntry ) == UTIL_OK ) 348 1606 { 349 1607 /* 350 1608 ** Decrease the number of messages that are processing... 351 1609 */ 352 1610 353 1611 aplink_s.bNbrOfCmdsActiveToAbcc--; 354 1612 355 1613 356 1614 /* 357 1615 ** We have received a new message. 358 1616 */ 359 1617 360 1618 if( ( psQEntry->sMsg.sHeader.bSourceId == (UINT8)0x01 ) && 361 1619 ( psQEntry->sMsg.sHeader.bDestObj == (UINT8)ABP_OBJ_NUM_NW ) && 362 1620 ( psQEntry->sMsg.sHeader.iInstance == 0x0001 ) && 363 1621 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_C_BIT ) ) ) && 364 1622 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_E_BIT ) ) ) && 365 1623 ( psQEntry->sMsg.sHeader.bDataSize == (UINT8)ABP_NW_IA_PARAM_SUPPORT_DS ) && 366 1624 ( psQEntry->sMsg.sHeader.bCmdExt0 == (UINT8)ABP_NW_IA_PARAM_SUPPORT ) && 367 1625 ( psQEntry->sMsg.sHeader.bCmdExt1 == (UINT8)0x00 ) ) 368 1626 { 369 1627 /* 370 1628 ** Response is OK. Read the data attached. 371 1629 */ 372 1630 373 1631 aplink_s.bParamSupport = psQEntry->sMsg.abData[ 0 ]; 374 1632 375 1633 ABCC_CbfDebugInfo( "APLINK/Configuration: Parameter support response received." ); 376 1634 377 1635 378 1636 /* 379 1637 ** Request pointers for the configuration. 380 1638 */ 381 1639 382 1640 ABCC_CbfAutoCfgRequest( aplink_s.iModuleType, 383 1641 aplink_s.iNetworkType, 384 1642 aplink_s.bParamSupport, 385 1643 &aplink_s.psReadCfg, 386 1644 &aplink_s.psWriteCfg ); 387 1645 388 1646 389 1647 /* 390 1648 ** Read the network data format support. 391 1649 */ 392 1650 393 1651 aplink_s.eCfgState = APLINK_CFG_SM_READ_NW_DATA_FORMAT; 394 1652 395 1653 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_READ_NW_DATA_FORMAT." ); 396 1654 } 397 1655 else 398 1656 { 399 1657 /* 400 1658 ** There is some error in the response. 401 1659 */ 402 1660 403 1661 ABCC_CbfDebugInfo( "APLINK/Configuration: Parameter support error response." ); 404 1662 405 1663 /* 406 1664 ** Signal a fatal error to the application 407 1665 */ 408 1666 409 1667 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_INVALID_PARAM_SUPPORT_RECEIVED ); 410 1668 411 1669 /* 412 1670 ** Change driver state, so the applicaton is able to send a RESET 413 1671 */ 414 1672 415 1673 APLINK_ChangeDriverState( APLINK_SM_IN_RUN_NO_PD ); 416 1674 417 1675 } /* End if( Response OK? ) */ 418 1676 419 1677 /* 420 1678 ** Free the allocated buffer. 421 1679 */ 422 1680 423 1681 UTIL_FreeMsgBuffer( psQEntry ); 424 1682 425 1683 } /* End if( New message? ) */ 426 1684 427 1685 428 1686 429 1687 break; /* End case APLINK_CFG_SM_READ_NW_PARAM_SUPPORT_RSP: */ 430 1688 431 1689 432 1690 case APLINK_CFG_SM_READ_NW_DATA_FORMAT: 433 1691 /* 434 1692 ** Allocate a buffer. 435 1693 */ 436 1694 437 1695 psQEntry = UTIL_AllocateMsgBuffer( &APLINK_asCmdToAbccBuf[ 0 ], 438 1696 ABCC_NBR_SIMULTANEOUS_APPL_COMMANDS ); 439 1697 440 1698 if( psQEntry == NULL ) 441 1699 { 442 1700 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_OUT_OF_BUFFERS ); 443 1701 } 444 1702 445 1703 446 1704 /* 447 1705 ** Read the Network data format of the module. 448 1706 */ 449 1707 450 1708 psQEntry->sMsg.sHeader.bSourceId = (UINT8)0x01; 451 1709 psQEntry->sMsg.sHeader.bDestObj = (UINT8)ABP_OBJ_NUM_NW; 452 1710 psQEntry->sMsg.sHeader.iInstance = 0x0001; 453 1711 psQEntry->sMsg.sHeader.bCmd = (UINT8)( ABP_CMD_GET_ATTR | ABP_MSG_HEADER_C_BIT ); 454 1712 psQEntry->sMsg.sHeader.bDataSize = (UINT8)0x00; 455 1713 psQEntry->sMsg.sHeader.bCmdExt0 = (UINT8)ABP_NW_IA_DATA_FORMAT; 456 1714 psQEntry->sMsg.sHeader.bCmdExt1 = (UINT8)0x00; 457 1715 458 1716 /* 459 1717 ** Post the message to the ABCC. 460 1718 */ 461 1719 462 1720 (void)aplink_AddFragAndPostMsg( psQEntry ); 463 1721 464 1722 465 1723 /* 466 1724 ** Wait for the response. 467 1725 */ 468 1726 469 1727 aplink_s.eCfgState = APLINK_CFG_SM_WAIT_NW_DATA_FORMAT_RSP; 470 1728 471 1729 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_WAIT_NW_DATA_FORMAT_RSP." ); 472 1730 473 1731 break; /* End case APLINK_CFG_SM_READ_NW_DATA_FORMAT: */ 474 1732 475 1733 476 1734 case APLINK_CFG_SM_WAIT_NW_DATA_FORMAT_RSP: 477 1735 /* 478 1736 ** Check if theres a new response for us. 479 1737 */ 480 1738 481 1739 if( UTIL_GetFirstMessageFromQueue( aplink_s.xMsgsFromAbccQueue, &psQEntry ) == UTIL_OK ) 482 1740 { 483 1741 /* 484 1742 ** Decrease the number of messages that are processing... 485 1743 */ 486 1744 487 1745 aplink_s.bNbrOfCmdsActiveToAbcc--; 488 1746 489 1747 490 1748 /* 491 1749 ** We have received a new message. 492 1750 */ 493 1751 494 1752 if( ( psQEntry->sMsg.sHeader.bSourceId == (UINT8)0x01 ) && 495 1753 ( psQEntry->sMsg.sHeader.bDestObj == (UINT8)ABP_OBJ_NUM_NW ) && 496 1754 ( psQEntry->sMsg.sHeader.iInstance == 0x0001 ) && 497 1755 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_C_BIT ) ) ) && 498 1756 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_E_BIT ) ) ) && 499 1757 ( psQEntry->sMsg.sHeader.bDataSize == (UINT8)ABP_NW_IA_DATA_FORMAT_DS ) && 500 1758 ( psQEntry->sMsg.sHeader.bCmdExt0 == (UINT8)ABP_NW_IA_DATA_FORMAT ) && 501 1759 ( psQEntry->sMsg.sHeader.bCmdExt1 == (UINT8)0x00 ) ) 502 1760 { 503 1761 /* 504 1762 ** Signal the network data format to the application. 505 1763 */ 506 1764 507 1765 ABCC_CbfNetworkDataFormat( (ABCC_DataFormatType)psQEntry->sMsg.abData[ 0 ] ); 508 1766 509 1767 ABCC_CbfDebugInfo( "APLINK/Configuration: Network data-type response received." ); 510 1768 511 1769 iMapCntr = 0; 512 1770 513 1771 /* 514 1772 ** Change state 515 1773 */ 516 1774 517 1775 aplink_s.eCfgState = APLINK_CFG_SM_NEXT_READ; 518 1776 519 1777 } 520 1778 else 521 1779 { 522 1780 /* 523 1781 ** There is some error in the response. 524 1782 */ 525 1783 526 1784 ABCC_CbfDebugInfo( "APLINK/Configuration: Network data-format error response." ); 527 1785 528 1786 /* 529 1787 ** Signal a fatal error to the application 530 1788 */ 531 1789 532 1790 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_INVALID_DATA_FORMAT_RECEIVED ); 533 1791 534 1792 /* 535 1793 ** Change driver state, so the applicaton is able to send a RESET 536 1794 */ 537 1795 538 1796 APLINK_ChangeDriverState( APLINK_SM_IN_RUN_NO_PD ); 539 1797 540 1798 } /* End if( New Message OK? ) */ 541 1799 542 1800 /* 543 1801 ** Free the allocated buffer. 544 1802 */ 545 1803 546 1804 UTIL_FreeMsgBuffer( psQEntry ); 547 1805 548 1806 } /* End if( New message? ) */ 549 1807 550 1808 551 1809 ABCC_CbfCfgSetAddress( Network_Address()); 552 1810 553 1811 break; /* End case APLINK_CFG_SM_WAIT_NW_DATA_FORMAT_RSP: */ 554 1812 555 1813 556 1814 case APLINK_CFG_SM_SEND_READ_MAPPING: 557 1815 /* 558 1816 ** Allocate a buffer. 559 1817 */ 560 1818 561 1819 psQEntry = UTIL_AllocateMsgBuffer( &APLINK_asCmdToAbccBuf[ 0 ], 562 1820 ABCC_NBR_SIMULTANEOUS_APPL_COMMANDS ); 563 1821 564 1822 if( psQEntry == NULL ) 565 1823 { 566 1824 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_OUT_OF_BUFFERS ); 567 1825 } 568 1826 569 1827 570 1828 /* 571 1829 ** Send a Read mapping message 572 1830 */ 573 1831 574 1832 psQEntry->sMsg.sHeader.bSourceId = (UINT8)0x01; 575 1833 psQEntry->sMsg.sHeader.bDestObj = (UINT8)ABP_OBJ_NUM_NW; 576 1834 psQEntry->sMsg.sHeader.iInstance = 0x0001; 577 1835 psQEntry->sMsg.sHeader.bCmd = (UINT8)( ABP_NW_CMD_MAP_ADI_READ_AREA | ABP_MSG_HEADER_C_BIT ); 578 1836 psQEntry->sMsg.sHeader.bDataSize = (UINT8)0x04; 579 1837 psQEntry->sMsg.sHeader.bCmdExt0 = (UINT8)( aplink_s.psReadCfg->psMaps[ iMapCntr ].iAdiNbr & 0x00FF ); 580 1838 psQEntry->sMsg.sHeader.bCmdExt1 = (UINT8)( ( aplink_s.psReadCfg->psMaps[ iMapCntr ].iAdiNbr >> 8 ) & 0x00FF ); 581 1839 582 1840 /* 583 1841 ** Assign the data type and the number of elements. 584 1842 */ 585 1843 586 1844 if(fsmc_sram_test_read(2) == 0X90) 587 1845 { 588 1846 aplink_s.psReadCfg->psMaps[ iMapCntr ].bDataType = 0; 589 1847 aplink_s.psReadCfg->psMaps[ iMapCntr ].bNbrElements = 16; 590 1848 psQEntry->sMsg.abData[ 0 ] = aplink_s.psReadCfg->psMaps[ iMapCntr ].bDataType; 591 1849 psQEntry->sMsg.abData[ 1 ] = aplink_s.psReadCfg->psMaps[ iMapCntr ].bNbrElements; 592 1850 } 593 1851 else 594 1852 { 595 1853 psQEntry->sMsg.abData[ 0 ] = aplink_s.psReadCfg->psMaps[ iMapCntr ].bDataType; 596 1854 psQEntry->sMsg.abData[ 1 ] = aplink_s.psReadCfg->psMaps[ iMapCntr ].bNbrElements; 597 1855 } 598 1856 // printf("%2X\r\n",psQEntry->sMsg.abData[ 0 ] ); 599 1857 // printf("%2X\r\n",psQEntry->sMsg.abData[ 1 ] ); 600 1858 601 1859 /* 602 1860 ** Assign the order number. Low byte first. 603 1861 */ 604 1862 605 1863 psQEntry->sMsg.abData[ 2 ] = (UINT8)( aplink_s.psReadCfg->psMaps[ iMapCntr ].iOrderNumber & 0x00FF ); 606 1864 psQEntry->sMsg.abData[ 3 ] = (UINT8)( ( aplink_s.psReadCfg->psMaps[ iMapCntr ].iOrderNumber >> 8 ) & 0x00FF ); 607 1865 608 1866 /* 609 1867 ** Store the number of bytes of this mapping. 610 1868 */ 611 1869 612 1870 iSingleEntrySize = ( aplink_GetSizeOfDataType( aplink_s.psReadCfg->psMaps[ iMapCntr ].bDataType ) * 613 1871 aplink_s.psReadCfg->psMaps[ iMapCntr ].bNbrElements ); 614 1872 615 1873 616 1874 /* 617 1875 ** Post the message to the ABCC. 618 1876 */ 619 1877 620 1878 (void)aplink_AddFragAndPostMsg( psQEntry ); 621 1879 622 1880 623 1881 /* 624 1882 ** Change state 625 1883 */ 626 1884 627 1885 aplink_s.eCfgState = APLINK_CFG_SM_WAIT_READ_MAPPING_RSP; 628 1886 629 1887 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_WAIT_READ_MAPPING_RSP." ); 630 1888 631 1889 break; /* End case APLINK_CFG_SM_SEND_READ_MAPPING: */ 632 1890 633 1891 634 1892 case APLINK_CFG_SM_WAIT_READ_MAPPING_RSP: 635 1893 /* 636 1894 ** Waite for a response 637 1895 */ 638 1896 639 1897 if( UTIL_GetFirstMessageFromQueue( aplink_s.xMsgsFromAbccQueue, &psQEntry ) == UTIL_OK ) 640 1898 { 641 1899 /* 642 1900 ** Decrease the number of messages that are processing... 643 1901 */ 644 1902 645 1903 aplink_s.bNbrOfCmdsActiveToAbcc--; 646 1904 647 1905 648 1906 /* 649 1907 ** We have received a new message. 650 1908 */ 651 1909 652 1910 if( ( psQEntry->sMsg.sHeader.bSourceId == (UINT8)0x01 ) && 653 1911 ( psQEntry->sMsg.sHeader.bDestObj == (UINT8)ABP_OBJ_NUM_NW ) && 654 1912 ( psQEntry->sMsg.sHeader.iInstance == 0x0001 ) && 655 1913 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_C_BIT ) ) ) && 656 1914 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_E_BIT ) ) ) && 657 1915 ( psQEntry->sMsg.sHeader.bDataSize == (UINT8)0x01 ) && 658 1916 ( psQEntry->sMsg.sHeader.bCmdExt0 == (UINT8)( aplink_s.psReadCfg->psMaps[ iMapCntr ].iAdiNbr & 0x00FF ) ) && 659 1917 ( psQEntry->sMsg.sHeader.bCmdExt1 == (UINT8)( ( aplink_s.psReadCfg->psMaps[ iMapCntr ].iAdiNbr >> 8 ) & 0x00FF ) ) ) 660 1918 { 661 1919 ABCC_CbfDebugInfo( "APLINK/Configuration: Read map added OK." ); 662 1920 663 1921 /* 664 1922 ** Response is OK. Read the data attached. 665 1923 */ 666 1924 667 1925 aplink_s.psReadCfg->psMaps[ iMapCntr ].bAreaOffset = psQEntry->sMsg.abData[ 0 ]; 668 1926 aplink_s.psReadCfg->psMaps[ iMapCntr ].bMapStatus = (UINT8)1; 669 1927 670 1928 /* 671 1929 ** Add the mapped data size. 672 1930 */ 673 1931 674 1932 aplink_s.iReadPdLength += iSingleEntrySize; 675 1933 676 1934 } 677 1935 else 678 1936 { 679 1937 /* 680 1938 ** Error in message 681 1939 */ 682 1940 683 1941 ABCC_CbfDebugInfo( "APLINK/Configuration: Read map error." ); 684 1942 685 1943 /* 686 1944 ** Response is NOT OK. Mark the mapping as not mapped. 687 1945 */ 688 1946 689 1947 aplink_s.psReadCfg->psMaps[ iMapCntr ].bAreaOffset = (UINT8)0; 690 1948 aplink_s.psReadCfg->psMaps[ iMapCntr ].bMapStatus = (UINT8)0; 691 1949 692 1950 } /* End if( correct message? ) */ 693 1951 694 1952 695 1953 /* 696 1954 ** Increase the number of mappings. 697 1955 */ 698 1956 699 1957 iMapCntr++; 700 1958 701 1959 702 1960 /* 703 1961 ** Check for more mappings. 704 1962 */ 705 1963 706 1964 aplink_s.eCfgState = APLINK_CFG_SM_NEXT_READ; 707 1965 708 1966 709 1967 /* 710 1968 ** Free the allocated buffer. 711 1969 */ 712 1970 713 1971 UTIL_FreeMsgBuffer( psQEntry ); 714 1972 715 1973 } /* End if( New Response? ) */ 716 1974 717 1975 break; /* End case APLINK_CFG_SM_WAIT_READ_MAPPING_RSP: */ 718 1976 719 1977 720 1978 case APLINK_CFG_SM_NEXT_READ: 721 1979 /* 722 1980 ** Check if there are more mappings. 723 1981 */ 724 1982 725 1983 if( ( aplink_s.psReadCfg != NULL ) && 726 1984 ( aplink_s.psReadCfg->iNbrMaps != 0 ) && 727 1985 ( aplink_s.psReadCfg->iNbrMaps <= 256 ) && 728 1986 ( iMapCntr < aplink_s.psReadCfg->iNbrMaps ) ) 729 1987 { 730 1988 /* 731 1989 ** There are more "READ"-mappings left. Change state. 732 1990 */ 733 1991 734 1992 aplink_s.eCfgState = APLINK_CFG_SM_SEND_READ_MAPPING; 735 1993 } 736 1994 else 737 1995 { 738 1996 /* 739 1997 ** Check if there is a write mapping available 740 1998 */ 741 1999 742 2000 if( ( aplink_s.psWriteCfg != NULL ) && 743 2001 ( aplink_s.psWriteCfg->iNbrMaps != 0 ) && 744 2002 ( aplink_s.psWriteCfg->iNbrMaps <= 256 ) ) 745 2003 { 746 2004 /* 747 2005 ** There are at least one write mapping available 748 2006 */ 749 2007 750 2008 iMapCntr = 0; 751 2009 752 2010 /* 753 2011 ** Change state 754 2012 */ 755 2013 756 2014 aplink_s.eCfgState = APLINK_CFG_SM_SEND_WRITE_MAPPING; 757 2015 758 2016 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_SEND_WRITE_MAPPING." ); 759 2017 } 760 2018 else 761 2019 { 762 2020 /* 763 2021 ** There are NO "WRITE"-mappings. Change driver state. 764 2022 */ 765 2023 766 2024 APLINK_ChangeDriverState( APLINK_SM_IN_RUN_NO_PD ); 767 2025 768 2026 769 2027 /* 770 2028 ** No read or write mapping available 771 2029 */ 772 2030 773 2031 ABCC_CbfCfgCompleted(); 774 2032 775 2033 } /* End if write mapping OK? ) */ 776 2034 777 2035 } /* End if( More Read mappings? ) */ 778 2036 779 2037 break; /* End case APLINK_CFG_SM_NEXT_READ: */ 780 2038 781 2039 782 2040 case APLINK_CFG_SM_SEND_WRITE_MAPPING: 783 2041 /* 784 2042 ** Allocate a buffer. 785 2043 */ 786 2044 787 2045 psQEntry = UTIL_AllocateMsgBuffer( &APLINK_asCmdToAbccBuf[ 0 ], 788 2046 ABCC_NBR_SIMULTANEOUS_APPL_COMMANDS ); 789 2047 790 2048 if( psQEntry == NULL ) 791 2049 { 792 2050 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_OUT_OF_BUFFERS ); 793 2051 } 794 2052 795 2053 796 2054 /* 797 2055 ** Send a Write mapping meassage 798 2056 */ 799 2057 800 2058 psQEntry->sMsg.sHeader.bSourceId = (UINT8)0x01; 801 2059 psQEntry->sMsg.sHeader.bDestObj = (UINT8)ABP_OBJ_NUM_NW; 802 2060 psQEntry->sMsg.sHeader.iInstance = 0x0001; 803 2061 psQEntry->sMsg.sHeader.bCmd = (UINT8)( ABP_NW_CMD_MAP_ADI_WRITE_AREA | ABP_MSG_HEADER_C_BIT ); 804 2062 psQEntry->sMsg.sHeader.bDataSize = (UINT8)0x04; 805 2063 psQEntry->sMsg.sHeader.bCmdExt0 = (UINT8)( aplink_s.psWriteCfg->psMaps[ iMapCntr ].iAdiNbr & 0x00FF ); 806 2064 psQEntry->sMsg.sHeader.bCmdExt1 = (UINT8)( ( aplink_s.psWriteCfg->psMaps[ iMapCntr ].iAdiNbr >> 8 ) & 0x00FF ); 807 2065 808 2066 /* 809 2067 ** Assign the data type and number of elements. 810 2068 */ 811 2069 812 2070 if(fsmc_sram_test_read(2) == 0X90) 813 2071 { 814 2072 aplink_s.psWriteCfg->psMaps[ iMapCntr ].bDataType = 0; 815 2073 aplink_s.psWriteCfg->psMaps[ iMapCntr ].bNbrElements = 16; 816 2074 psQEntry->sMsg.abData[ 0 ] = aplink_s.psWriteCfg->psMaps[ iMapCntr ].bDataType; 817 2075 psQEntry->sMsg.abData[ 1 ] = aplink_s.psWriteCfg->psMaps[ iMapCntr ].bNbrElements; 818 2076 } 819 2077 else 820 2078 { 821 2079 psQEntry->sMsg.abData[ 0 ] = aplink_s.psWriteCfg->psMaps[ iMapCntr ].bDataType; 822 2080 psQEntry->sMsg.abData[ 1 ] = aplink_s.psWriteCfg->psMaps[ iMapCntr ].bNbrElements; 823 2081 } 824 2082 825 2083 /* 826 2084 ** Assign the order number. Low byte first. 827 2085 */ 828 2086 829 2087 psQEntry->sMsg.abData[ 2 ] = (UINT8)( aplink_s.psWriteCfg->psMaps[ iMapCntr ].iOrderNumber & 0x00FF ); 830 2088 psQEntry->sMsg.abData[ 3 ] = (UINT8)( ( aplink_s.psWriteCfg->psMaps[ iMapCntr ].iOrderNumber >> 8 ) & 0x00FF ); 831 2089 832 2090 833 2091 /* 834 2092 ** Store the number of bytes of this mapping. 835 2093 */ 836 2094 837 2095 iSingleEntrySize = ( aplink_GetSizeOfDataType( aplink_s.psWriteCfg->psMaps[ iMapCntr ].bDataType ) * 838 2096 aplink_s.psWriteCfg->psMaps[ iMapCntr ].bNbrElements ); 839 2097 840 2098 /* 841 2099 ** Post the message to the ABCC. 842 2100 */ 843 2101 844 2102 (void)aplink_AddFragAndPostMsg( psQEntry ); 845 2103 846 2104 847 2105 /* 848 2106 ** Change state 849 2107 */ 850 2108 851 2109 aplink_s.eCfgState = APLINK_CFG_SM_WAIT_WRITE_MAPPING_RSP; 852 2110 853 2111 ABCC_CbfDebugInfo( "APLINK/Configuration: In APLINK_CFG_SM_WAIT_WRITE_MAPPING_RSP." ); 854 2112 855 2113 break; /* End case APLINK_CFG_SM_SEND_WRITE_MAPPING: */ 856 2114 857 2115 858 2116 case APLINK_CFG_SM_WAIT_WRITE_MAPPING_RSP: 859 2117 /* 860 2118 ** Waite for a response 861 2119 */ 862 2120 863 2121 if( UTIL_GetFirstMessageFromQueue( aplink_s.xMsgsFromAbccQueue, &psQEntry ) == UTIL_OK ) 864 2122 { 865 2123 /* 866 2124 ** Decrease the number of messages that are processing... 867 2125 */ 868 2126 869 2127 aplink_s.bNbrOfCmdsActiveToAbcc--; 870 2128 871 2129 872 2130 /* 873 2131 ** We have received a new message. 874 2132 */ 875 2133 876 2134 if( ( psQEntry->sMsg.sHeader.bSourceId == (UINT8)0x01 ) && 877 2135 ( psQEntry->sMsg.sHeader.bDestObj == (UINT8)ABP_OBJ_NUM_NW ) && 878 2136 ( psQEntry->sMsg.sHeader.iInstance == 0x0001 ) && 879 2137 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_C_BIT ) ) ) && 880 2138 ( !( (BOOL8)( psQEntry->sMsg.sHeader.bCmd & (UINT8)ABP_MSG_HEADER_E_BIT ) ) ) && 881 2139 ( psQEntry->sMsg.sHeader.bDataSize == (UINT8)0x01 ) && 882 2140 ( psQEntry->sMsg.sHeader.bCmdExt0 == (UINT8)( aplink_s.psWriteCfg->psMaps[ iMapCntr ].iAdiNbr & 0x00FF ) ) && 883 2141 ( psQEntry->sMsg.sHeader.bCmdExt1 == (UINT8)( ( aplink_s.psWriteCfg->psMaps[ iMapCntr ].iAdiNbr >> 8 ) & 0x00FF ) ) ) 884 2142 { 885 2143 /* 886 2144 ** Response is OK. Read the data attached. 887 2145 */ 888 2146 889 2147 aplink_s.psWriteCfg->psMaps[ iMapCntr ].bAreaOffset = psQEntry->sMsg.abData[ 0 ]; 890 2148 aplink_s.psWriteCfg->psMaps[ iMapCntr ].bMapStatus = (UINT8)1; 891 2149 892 2150 /* 893 2151 ** Add the mapped data size. 894 2152 */ 895 2153 896 2154 aplink_s.iWritePdLength += iSingleEntrySize; 897 2155 898 2156 899 2157 ABCC_CbfDebugInfo( "APLINK/Configuration: Write map OK." ); 900 2158 } 901 2159 else 902 2160 { 903 2161 /* 904 2162 ** Error in message 905 2163 */ 906 2164 907 2165 ABCC_CbfDebugInfo( "APLINK/Configuration: Write map error." ); 908 2166 909 2167 /* 910 2168 ** Response is NOT OK. Mark the map. 911 2169 */ 912 2170 913 2171 aplink_s.psWriteCfg->psMaps[ iMapCntr ].bAreaOffset = (UINT8)0; 914 2172 aplink_s.psWriteCfg->psMaps[ iMapCntr ].bMapStatus = (UINT8)0; 915 2173 916 2174 } /* End if( correct message? ) */ 917 2175 918 2176 919 2177 /* 920 2178 ** Increase the number of mappings. 921 2179 */ 922 2180 923 2181 iMapCntr++; 924 2182 925 2183 926 2184 /* 927 2185 ** Check if more mappings... 928 2186 */ 929 2187 930 2188 aplink_s.eCfgState = APLINK_CFG_SM_NEXT_WRITE; 931 2189 932 2190 933 2191 /* 934 2192 ** Free the allocated buffer. 935 2193 */ 936 2194 937 2195 UTIL_FreeMsgBuffer( psQEntry ); 938 2196 939 2197 // ABCC_CbfCfgSetAddress(Network_Address()); 940 2198 // ABCC_CbfCfgSetBand(Network_Band()); //这儿加的设置波特率的函数 941 2199 942 2200 } /* End if( New Response? ) */ 943 2201 944 2202 break; /* End case APLINK_CFG_SM_WAIT_WRITE_MAPPING_RSP: */ 945 2203 946 2204 947 2205 case APLINK_CFG_SM_NEXT_WRITE: 948 2206 /* 949 2207 ** Check if there are more "WRITE"-mappings to process. 950 2208 */ 951 2209 952 2210 if( iMapCntr < aplink_s.psWriteCfg->iNbrMaps ) 953 2211 { 954 2212 /* 955 2213 ** Change state 956 2214 */ 957 2215 958 2216 aplink_s.eCfgState = APLINK_CFG_SM_SEND_WRITE_MAPPING; 959 2217 } 960 2218 else 961 2219 { 962 2220 /* 963 2221 ** No more mappings to process. 964 2222 ** Change driver state 965 2223 */ 966 2224 967 2225 APLINK_ChangeDriverState( APLINK_SM_IN_RUN_NO_PD ); 968 2226 969 2227 /* 970 2228 ** No more mapping available 971 2229 */ 972 2230 973 2231 974 2232 // if(fsmc_sram_test_read(2) == 0X90)/*只有在模块是CC-Link时，才配置波特率*/ 975 2233 // { 976 2234 977 2235 // // } 978 2236 ABCC_CbfCfgCompleted(); 979 2237 980 2238 } /* End if( More Write mappings? ) */ 981 2239 982 2240 break; /* End case APLINK_CFG_SM_NEXT_WRITE: */ 983 2241 984 2242 985 2243 default: 986 2244 987 2245 /* 988 2246 ** Signal a fatal error to the application 989 2247 */ 990 2248 991 2249 ABCC_CbfDriverError( ABCC_SEV_FATAL, ABCC_EC_ILLEGAL_CFG_STATE ); 992 2250 993 2251 break; 994 2252 995 2253 } /* End switch( aplink_s.eCfgState ) */ 996 2254 997 2255 } /* End of aplink_RunCfgStateMachine() */ 998 2256 999 2257 1000 2258 /*------------------------------------------------------------------------------ 1001 2259 ** aplink_HandleQueuedMsgsToAppl() 1002 2260 **------------------------------------------------------------------------------ 1003 2261 */ 1004 2262 1006 1 void ABCC_CbfCfgSetBand( UINT8 band ) 1007 2 { 1008 3 1009 4 /* Message Definition */ 1010 5 ABP_MsgType sMsg; 1011 6 sMsg.sHeader.bSourceId = 4;// SourceId = 3 1012 7 sMsg.sHeader.bDestObj = 4;// Object Anybus Object (04h) 1013 8 sMsg.sHeader.iInstance = 2;// Instance = 1 1014 9 sMsg.sHeader.bCmd = 0x42;// Command, Set attribute 1015 10 sMsg.sHeader.bDataSize = 1;// Data size = 1 byte 1016 11 sMsg.sHeader.bCmdExt0 = 5;// Attribute = 5 (‘setup Complete‘-flag) 1017 12 sMsg.sHeader.bCmdExt1 = 0;// (reserved) 1018 13 sMsg.abData[ 0 ] = band;// Data 1019 14 ABCC_SendMessage( &sMsg ); // Send Message 1020 15 1021 16 } /* End of ABCC_CbfCfgSetBand() */ //设置波特率的函数
标签：des style blog io ar color os sp for
原文地址：http://www.cnblogs.com/cronusskl/p/4107611.html
