Advertisement
Guest User

Untitled

a guest
Feb 24th, 2020
162
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.11 KB | None | 0 0
  1.              //PDO re-mapping****************************************************************************************************
  2.              for (k=0; k<NUMOFMAXPOS_DRIVE; ++k)
  3.              {
  4.                  if (( ec_slavecount >= 1 ) && (strcmp(ec_slave[k+1].name,"MAXPOS") == 0)) //change name for other drives
  5.                  {
  6.                      printf("Re mapping for MAXPOS...\n");
  7.                     os=sizeof(ob2); ob2 = 0x1600;   //RxPDO, check MAXPOS ESI
  8.                     //0x1c12 is Index of Sync Manager 2 PDO Assignment (output RxPDO), CA (Complete Access) must be TRUE
  9.                     wkc_count=ec_SDOwrite(k+1, 0x1c12,01,TRUE,os, &ob2,EC_TIMEOUTRXM);  //change slave position (k+1) if needed
  10.  
  11.                      if (wkc_count==0)
  12.                      {
  13.                          printf("RxPDO assignment error\n");
  14.                          return FALSE;
  15.                      }
  16.                    
  17.                      os=sizeof(ob2); ob2 = 0x1a00;  //TxPDO, check MAXPOS ESI
  18.                      //0x1c13 is Index of Sync Manager 3 PDO Assignment (input TxPDO), CA (Complete Access) must be TRUE
  19.                      wkc_count=ec_SDOwrite(k+1, 0x1c13,01,TRUE,os, &ob2,EC_TIMEOUTRXM); //change slave position (k+1) if needed
  20.                      if (wkc_count==0)
  21.                      {
  22.                          printf("TxPDO assignment error\n");
  23.                          return FALSE;
  24.                      }
  25.                  }
  26.              }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement