Mercurial Mercurial > canfestival / comparison
summary | shortlog | changelog | graph | tags | bookmarks | branches | files | changeset | file | latest | revisions | annotate | diff | comparison | raw | help
examples/win32test/main.c
changeset 701 9e4ccb3cab96
parent 653 e2d0c5251fbd
child 727 aebbcdd34590
equal deleted inserted replaced
700:23df92154894 701:9e4ccb3cab96 
    74       sleep_proc(1);   
    74       sleep_proc(1);   
    75       }
 
    75       }
 
    76    return 0xFF;
 
    76    return 0xFF;
 
    77    }
 
    77    }
 
    78 
    78 
    79 UNS8 ReadSDO(UNS8 nodeId, UNS16 index, UNS8 subIndex, UNS8 dataType, void* data, UNS8* size)
 
    79 UNS8 ReadSDO(UNS8 nodeId, UNS16 index, UNS8 subIndex, UNS8 dataType, void* data, UNS32* size)
 
    80    {
 
    80    {
 
    81    UNS32 abortCode = 0;
 
    81    UNS32 abortCode = 0;
 
    82    UNS8 res = SDO_UPLOAD_IN_PROGRESS;
 
    82    UNS8 res = SDO_UPLOAD_IN_PROGRESS;
 
    83    // Read SDO
 
    83    // Read SDO
 
    84    UNS8 err = readNetworkDict (&win32test_Data, nodeId, index, subIndex, dataType);
 
    84    UNS8 err = readNetworkDict (&win32test_Data, nodeId, index, subIndex, dataType, 0);
 
    85    if (err)
 
    85    if (err)
 
    86       return 0xFF;
 
    86       return 0xFF;
 
    87    for(;;)
 
    87    for(;;)
 
    88       {
 
    88       {
 
    89       res = getReadResultNetworkDict (&win32test_Data, nodeId, data, size, &abortCode);
 
    89       res = getReadResultNetworkDict (&win32test_Data, nodeId, data, size, &abortCode);
 
   157          {
 
   157          {
 
   158          /* modify Client SDO 1 Parameter */
 
   158          /* modify Client SDO 1 Parameter */
 
   159          UNS32 COB_ID_Client_to_Server_Transmit_SDO = 0x600 + node_id;
 
   159          UNS32 COB_ID_Client_to_Server_Transmit_SDO = 0x600 + node_id;
 
   160          UNS32 COB_ID_Server_to_Client_Receive_SDO  = 0x580 + node_id;
 
   160          UNS32 COB_ID_Server_to_Client_Receive_SDO  = 0x580 + node_id;
 
   161          UNS32 Node_ID_of_the_SDO_Server = node_id;
 
   161          UNS32 Node_ID_of_the_SDO_Server = node_id;
 
   162          UNS8 ExpectedSize = sizeof (UNS32);
 
   162          UNS32 ExpectedSize = sizeof (UNS32);
 
   163 
   163 
   164          if (OD_SUCCESSFUL ==  writeLocalDict(&win32test_Data, 0x1280, 1, &COB_ID_Client_to_Server_Transmit_SDO, &ExpectedSize, RW) 
   164          if (OD_SUCCESSFUL ==  writeLocalDict(&win32test_Data, 0x1280, 1, &COB_ID_Client_to_Server_Transmit_SDO, &ExpectedSize, RW) 
   165               && OD_SUCCESSFUL ==  writeLocalDict(&win32test_Data, 0x1280, 2, &COB_ID_Server_to_Client_Receive_SDO, &ExpectedSize, RW) 
   165               && OD_SUCCESSFUL ==  writeLocalDict(&win32test_Data, 0x1280, 2, &COB_ID_Server_to_Client_Receive_SDO, &ExpectedSize, RW) 
   166               && OD_SUCCESSFUL ==  writeLocalDict(&win32test_Data, 0x1280, 3, &Node_ID_of_the_SDO_Server, &ExpectedSize, RW))
 
   166               && OD_SUCCESSFUL ==  writeLocalDict(&win32test_Data, 0x1280, 3, &Node_ID_of_the_SDO_Server, &ExpectedSize, RW))
 
   167             {
 
   167             {
 
   170             char hw_ver[64]="";
 
   170             char hw_ver[64]="";
 
   171             char sw_ver[64]="";   
   171             char sw_ver[64]="";   
   172             UNS32 vendor_id = 0;            
   172             UNS32 vendor_id = 0;            
   173             UNS32 prod_code = 0;
 
   173             UNS32 prod_code = 0;
 
   174             UNS32 ser_num = 0;
 
   174             UNS32 ser_num = 0;
 
   175             UNS8 size;
 
   175             UNS32 size;
 
   176             UNS8 res;
 
   176             UNS8 res;
 
   177 
   177 
   178             printf("\nnode_id: %d (%xh) info\n",(int)node_id,(int)node_id);
 
   178             printf("\nnode_id: %d (%xh) info\n",(int)node_id,(int)node_id);
 
   179             printf("********************************************\n");
 
   179             printf("********************************************\n");
 
   180 
   180
canfestival