CANopen Protocol

softMC provides a number of categories of services that allow operation of CANopen device.

Upload and Download Service Objects

Application can read(upload) from or write (download) to device CANopen service data objects using either segmented or expedite SDO upload/download mechanism.
Those functions are implemented in CANOPEN.LIB

• CAN_SDO_READ_STRING - segmented upload of byte array
• CAN_SDO_READ - expedite upload of 32-bit integer
• CAN_SDO_READ_REAL - expedite upload of single precision floating point number
• CAN_SDO_WRITE_STRING - segmented download of byte array
• CAN_SDO_WRITE - expedite download of 32-bit integer
• CAN_SDO_WRITE_REAL - expedite download of single precision floating point number

Controlling Device State Machine

bus[0].phase = 0 ' put CAN device to PREOP mode
bus[0].phase = 4 ' put CAN device to OP mode

Configuration of Motion Objects

softMC requires DS402 compliant digital drive that supports following modes of operation and objects

• Mandatory Cyclic Synchronous Position mode (so-called opmode 8)
  
• Optional Cyclic Synchronous Torque mode mode
  

PDO mappable objects
Device shall provide following objects, object numbers may be different from standard.

• Control Word - object 0x6040.0
  
• Status Word - object 0x6041.0
  
• 32-bit Target position - object 0x607a.0
  
• 32-bit Position feedback - object 0x6064.0
  

Optional Digital Inputs and Outputs

PDO mapping and association between these objects and internal data structures of softMC is shown in the example DS402 CAN Drive_Setup.
Corresponding firmware function are listed in CANopen Firmware Functions.

Synchronization

For every bus cycle softMC broadcasts SYNC message to the devices and then sends to every slave a TX PDO that contains control word, target position and optional digital otputs. The motion controller expects all devices to send its TX PDO with the status word and the position feedback before the next SYNC.
A bus cycle is triggered by a hardware timer therefore SYNC messages are sent to the slaves with low jitter that should not exceed 70 usecs.
Devices shall lock their PLLs to the softMC SYNC cycle and tolerate SYNC jitter of up to 100 usecs.

Bus Cycle Example

<Start cycle>
MasterTPDO1
MasterTPDO2
Dummy message
SYNC
..
..
Device1 TDPDO1
Device1 TDPDO2
..
DeviceN TDPDO1
DeviceN TDPDO2
<Start cycle>