Complete high performance microstepping system (2 pages)
Summary of Contents for Intelligent Motion Systems MDrive DSP-402
Page 1
Excellence in Motion DSP-402 APPLICATION GUIDE CANopen FORCE DRIVE CANopen...
Page 2
Intelligent Motion Systems, Inc., reserves the right to make changes without further notice to any products herein to improve reliability, function or design. Intelligent Motion Systems, Inc., does not assume any liability arising out of the application or use of any product or circuit described herein;...
Section 1 Introduction to the MDrivePlus CANopen DSP-402 Implementation Introduction This document describes the Operational Modes and Objects utilized by the MDrivePlus CANopen. The MDrivePlus uses the CiA DSP402 protocol as described the the CiA document CANopen Device Profile for Drives and Motion Control V2.0B. CAN Message Format The MDrivePlus is compliant with CAN 2.0B Active Specification.
Device Control The starting and stopping of the drive and several mode specific commands are executed by the state machine. Modes of Operation The operation mode defines the behavior of the drive. The following modes are defined in this profile: Homing Mode This chapter describes the various methods to find a home position (also: reference point, datum, zero point).
Trajectory Generator The chosen operation mode and the corresponding parameters (objects) define the input of the Trajectory Generator. The Trajectory Generator supplies the control loop(s) with the demand values. They are generally mode specific. Each Mode may use its own Trajectory Generator. A general description of its functionality is given in Section X, which is related to the Profile Position Mode.
Object Formatting This manual will display the Object and Entry data using the model detailed below. Object Description Index Name XXXX Index Name Index The Index is the hexadecimal number that represents the index number of the object in the CANopen Object Dictionary.
PDO Mapping Describes whether (Yes) or not (No) the Index may be mapped to a PDO (Process Data Object). If yes it may be mapped to a PDO, if No the Object must be accessed using SDO (Service Data Objects). Category M ...Mandatory O ...
Page 16
Page Intentionally Left Blank MDrivePlus CANopen R020507...
Section 2 Introduction The access from the CAN network to the drive is done through data objects. Process Data Object (PDO) PDOs are messages in an unconfirmed service. They are used for the transfer of real-time data to and from the drive. The transfer is fast, because it is performed with no protocol overhead what means to transport eight application data bytes in one CAN-frame.
PDO Mapping The MDrivePlus CANopen allows you to map objects to PDOs to reduce the transfer application data more efficiently. By using the PDO the user can map a PDO to multiple objects (8 Data Bytes max.) The example will show RPDO 1400 RPDO Index 1600 1600...
Section 3 Introduction The objects detailed in this section are IMS manufacturer specific configuration objects to conFigure : • I/O Type • Run/Hold Current • Factory Configuration Accessibility Codes R — Read W — Write S — Storable to Nonvolatile Memory (NVM) K —...
Object 2002h: I/O Discretes (Config) Object Description Index Name 2002 Config Input Switches Entry Description Sub-Index Description ConFigure I/O as Home ConFigure I/O as Positive Limit ConFigure I/O as Negative Limit Object 2004h: Input Filter Mask (Config) The Input Filter Mask Object conFigure s the device to filter the selected inputs. The operation of the Object is shown in Figure 3.1 below.
Object 2010h: Analog Input Object Description Index Name 2010 Analog Input Entry Description Sub-Index Description Analog Reading Analog Input Configuration Input Filtering Object 2020h: Software Limits as Hardware Limits Object Description Index Name 2020 Software Limits as Hardware Entry Description Sub-Index Description Limit Reached Flag...
Object 2031h: Unit Options (Encoder Enable, Capture In/Trip Out) Object Description Index Name 2031 Unit Options Entry Description Access PDO Mapping R/W/S Note: Encoder functions only apply to the MDrive products. The MForce products do not have closed loop capability. 0x80 0x40 Position...
Entry Description Sub-Index Description Enable Capture Position Enable Capture Input Flag Capture Input Filter Capture In Position Object 2204h: Run Current Percent Object Description Index Name 2204 Run Current % Entry Description Access PDO Mapping R/W/S 2204 MDrivePlus (All) MDrive Range 0 To Actual Current Not required as Motor is appropriately sized...
2205 MDrivePlus (All) MDrive Range 0 To Actual Current Not required as Motor is appropriately sized Shaded Area Reserved for Future Use *HC=67 for maximum 2.0 Amp Hold Current Object 2211h: Position Present Point Target Object Description Index Name 2211 Position Present Point Target Entry Description...
Entry Description Access PDO Mapping Object 5002h: ASCII Serial Number The following object is set at the factory, and is not user configurable. It can be read by the user in the event that the con- tained data is needed for technical or application support. Object Description Index Name...
Section 4 Device Control The device control function block controls all the func- tions of the MDrivePlus CANopen and is divided into to sections: 1. Control of the State Machine 2. Operation Mode Control and Status words Controlword (Object Index 6040h) controls the state and operation modes of the MDrivePlus CANopen.
Transition From State Number Start Not Ready To Switch On Switch On Disabled Ready to Switch On Switched On Operation Enable Switched On Ready to Switch On Operation Enable Operation Enable Switched On Operation Enable Quick Stop Active All States Fault Reaction Active Fault...
Controlword 6040 Power Disabled Start Not Ready to Switch On Switch On Disabled Ready To Switch On Switched On Operation Enable Power Enabled Statusword Figure 4.2: State Machine States/Transitions Block Diagram Notes On State Transitions Commands directing a change in state are processed completely and the new state achieved before additional state change commands are processed.
Object 6040 — Controlword Ths controlword is a mandatory, unsigned 16 bit number containing bits for controlling the state and operating modes for the MDrivePlus pen. Object Description Index 6040 Entry Description Access Data Description Manufacturer Specific O=Optional M= Mandatory Device Control Command Bit Patterns (Bits 0-3 and 7) Command Fault Reset...
Object 6041 — Statusword The Statusword is a read-only object that indicates the current state of the drive, no bits are latched. Statusword consists of bits for: The current state of the drive. The operating state of the mode. ...
Page 38
Bit 4: Voltage Enabled The Disable Voltage request is active when the voltage_disabled bit is cleared to 0. Bit 5: Quick Stop Active When reset, this bit indicates that the drive is reacting on a quick stop request. Bits 0, 1 and 2 of the statusword must be set to 1 to indicate that the drive is capable to regenerate.
Section 5 Object 6060 — Modes of Operation The performance of the MDrivePlus CANopen depends on the activated Modes of Operation. It is not possible to operates the modes in parallel. The user must select a mode to operate in. An example of exclusive functions are Profile Velocity and Profile Position modes.
Mode of Operation (6060 8...127 Gray Text modes unsupported by MDrivePlus CANopen Object 6061 — Modes of Operation Display The Modes of Operation Display shows the current mode of operation. The meaning of the returned value corresponds to that of the Modes of Operation option code (index 6060h) Object Description Index Name...
Page 41
16 15 Reserved Cyclic Sync Torque MFG Specific Cyclic Sync Velocity Cyclic Sync Position 1 = Mode Supported 0 = Mode Not Supported Part 2: DSP-402 Implementation Interpolated Position Homing Reserved Profile Torque Profile Velocity Velocity Profile Position Figure 5.3: Supported Drive Modes...
Page 42
Page Intentionally Left Blank MDrivePlus CANopen R020507...
Section 6 General Information A target_position is applied to the Trajectory Generator. It is generating a position_demand_value for the position control loop described in the Position Control Function Section. These two function blocks are optionally controlled by individual parameter sets. Position Velocity Multiplier...
Functional Description There are two different ways to apply target_positions to a drive, are supported by this device profile. Set of set-points: After reaching the target_position the drive unit immediately processes the next target_position which results in a move where the velocity of the drive normally is not reduced to zero after achieving a set-point. Single set-point: After reaching the target_position the drive unit signals this status to a host computer and then receives a new set- point.
Velocity target_position X 1 Figure 6.3: Single Set-Point Mode (Move After a Move) 6040h Bit 5=0 With change_set_immediately set to “1” a new set-point immediately after reaching the last one. The relative timing of the other signals is unchanged. This behavior causes the drive to already process the next set-point X Then drive moves immediately to the already calculated next target_position X Velocity...
Statusword (6041 ) of Profile Position Mode See 1.4 Following Error Name Value Target Reached Set-Point Acknowledge Following Error Object 607A — Target Position The Target Position is the position that the drive should move to in position profile mode using the MDrivePlus CANopen parameters such as velocity, acceleration, deceleration, motion profile type etc.
Object 6082 — End Velocity The end velocity defines the velocity which the drive must have on reaching the target position. Normally, the drive stops at the target position, i.e. the end_velocity = 0. The end velocity is given in the Object Description Index Name...
Object 6086 — Motion Profile Type The Motion Profile Type is used to select the type of motion profile used to perform a move. The MDrivePlus CANopen is fixed at Value 0: Linear Ramp (Trapezoidal Profile) Object Description Index Name 6086 Motion Profile Type Entry Description...
Section 7 General Information This chapter describes the method by which a drive seeks the home position (also called, the datum, reference point or zero point). There are various methods of achieving this using limit switches at the ends of travel or a home switch (zero point switch) in mid-travel, most of the methods also use the index (zero) pulse train from an incremental encoder.
Statusword (6041 ) of Homing Mode See 1.4 Homing Error Name Value Target Reached Homing Attained Following Error Homing Offset (607Ch) This object shall indicate the conFigure d difference between the zero position for the application and the machine home position (found during homing).
Homing Method (6098h) The homing method object determines the method that will be used during homing. Object Description Index Name 6098 Homing Method Entry Description Access PDO Mapping Possible Data Description Value Description -128 — -1 Manufacturer Specific No Homing Operation Required 1 —...
Method 2: Homing on the Positive Limit Switch and Index Pulse Using this method the initial direction of movement is rightward if the positive limit switch is inactive (here shown as low). The position of home is at the first index pulse to the left of the position where the positive limit switch becomes inactive.
Index Pulse Home Switch Figure 7.6: Homing on the Negative Home Switch and Index Pulse Methods 7 to 14: Homing on the Home Switch and Index Pulse These methods use a home switch which is active over only portion of the travel, in effect the switch has a ‘momentary’...
Figure 7.8: Homing on the Home Switch and Index Pulse - Negative Initial Move Methods 15 and 16: Reserved These methods are reserved for future expansion of the homing mode. Methods 17 to 30: Homing without an Index Pulse These methods are similar to methods 1 to 14 except that the home position is not dependent on the index pulse but only Dependent on the relevant home or limit switch transitions.
Methods 33 and 34: Homing on an Index Pulse Using methods 33 or 34 the direction of homing is negative or positive respectively. The home position is at the index pulse found in the selected direction. Index Pulse Method 35: Homing on the Current Position In method 35 the current position is taken to be the home position.
Page 56
Page Intentionally Left Blank MDrivePlus CANopen R020507...
Section 8 General Information In this chapter, all parameters are described which are necessary for a closed loop position control. The control loop is fed with the position_demand_value as one of the outputs of the Trajectory Generator and with the output of the position detec- tion unit (position_actual_value) like a resolver or encoder as input parameters.
Object 6065 — Following Error Window This object shall indicate the conFigure d range of tolerated position values symmetrically to the position demand value. If the position actual value is out of the following error window, a following error occurs. A following error may occur when a drive is blocked, unreachable profile velocity occurs, or at wrong closed- loop coefficients.
Section 9 Controlword (6040 ) of Profile Velocity Mode See 1.3 Halt See 1.3 Name Value Halt Statusword (6041 ) of Profile Velocity Mode See 1.4 Max Slippage Error Name Value Target Reached Speed Max Slippage Error Object 606C — Velocity Actual Value This object shall provide the actual velocity value derived either from the velocity sensor or the position sensor.
Object 60FF — Target Velocity The Target Velocity is the input to the trajectory generator and the value is given in microsteps/second. Object Description Index Name 60FF Target Velocity Entry Description Access PDO Mapping Object 60F8 — Maximum Slippage This object shall indicate the conFigure d maximal slippage of an asynchronous motor. When the max slippage has been reached, the corresponding bit 13 max slippage error in the statusword shall be set to 1.
Section 10 Object 60FD — Digital Inputs This object provides for digital inputs. Inputs 12, 11, 10, 9, 4, 3, 2, 1 = Switched Off = Switched On Object Description Index Name 60FD Digital Inputs Entry Description Access PDO Mapping Part 2: DSP-402 Implementation Optional Application FE (General I/O) Reserved...
Object 60FE — Digital Outputs This object provides for digital outputs. Outputs 12, 11, 10, 9, 4, 3, 2, 1 = Switch Off = Switch On Object Description Index Name 60FE Digital Outputs Entry Description Sub-Index Description Highest Supported Sub- Index Physical Outputs Bit mask...
TWENTY-FOUR (24) MONTH LIMITED WARRANTY Intelligent Motion Systems, Inc. (“IMS”), warrants only to the purchaser of the Product from IMS (the “Customer”) that the product purchased from IMS (the “Product”) will be free from defects in materials and workmanship under the normal use and service for which the Product was designed for a period of 24 months from the date of purchase of the Product by the Customer.
Need help?
Do you have a question about the MDrive DSP-402 and is the answer not in the manual?
Questions and answers