src/sdo.c
changeset 651 2a36570aa68c
parent 636 033fe6f1ec3c
child 656 f923456f01e5
equal deleted inserted replaced
650:58b07a7e695b 651:2a36570aa68c
  1456     d->transfers[line].offset = count;
  1456     d->transfers[line].offset = count;
  1457   }
  1457   }
  1458   else { /** Normal transfert */
  1458   else { /** Normal transfert */
  1459     sdo.body.data[0] = (1 << 5) | 1;
  1459     sdo.body.data[0] = (1 << 5) | 1;
  1460     for (i = 0 ; i < 4 ; i++)
  1460     for (i = 0 ; i < 4 ; i++)
  1461       sdo.body.data[i+4] = (UNS8)((count << (i<<3))); /* i*8 */
  1461       sdo.body.data[i+4] = (UNS8)((count >> (i<<3))); /* i*8 */
  1462   }
  1462   }
  1463   sdo.body.data[1] = index & 0xFF;        /* LSB */
  1463   sdo.body.data[1] = index & 0xFF;        /* LSB */
  1464   sdo.body.data[2] = (index >> 8) & 0xFF; /* MSB */
  1464   sdo.body.data[2] = (index >> 8) & 0xFF; /* MSB */
  1465   sdo.body.data[3] = subIndex;
  1465   sdo.body.data[3] = subIndex;
  1466 
  1466