Overview: The document is a comprehensive manual for the CANopen Communication Profile of the INFRANOR CD1-k drive, specifically for hardware release version 2.0 and firmware release from version 11.E3. It emphasizes the necessity of consulting the installation and user guides for proper setup and operation. The manual is intended for skilled technicians familiar with electronics and servo systems, adhering to EN 60204-1 standards.
Warnings and Compliance: The manual highlights the importance of reading all instructions before operating the amplifiers. It stresses that maintenance should only be performed by qualified personnel. Compliance with CE standards is contingent upon following the manual's recommendations. The document also addresses WEEE regulations, indicating that INFRANOR products fall under Category 9 for monitoring and control instruments, and outlines the recycling obligations in France through RECYLUM.
Safety Instructions: The manual provides critical safety instructions, including waiting at least 5 minutes after power down before handling amplifiers due to residual voltage risks. It also covers ESD precautions, advising on proper storage and handling to prevent damage from electrostatic discharge.
Communication Profile: The document details the CANopen communication objects, including CAN Telegram, Default COB-ID, Network Management Objects (NMT), Synchronisation Object (SYNC), Process Data Object (PDO), Service Data Object (SDO), and Emergency Object (EMCY). It explains the network initialization and system boot-up processes, including the NMT state machine and initialization procedures.
Object Dictionary: The manual provides an extensive overview of the object dictionary, detailing various objects such as Device Type, Error Register, Manufacturer Device Name, and others. It includes information on Sync Objects, SDO Objects, Emergency Objects, and PDO Objects, with specific parameters and mappings.
Device Profile: The document outlines the PDO mapping for receive and transmit PDOs, common entries in the object dictionary, and device control mechanisms. It describes the drive state machine and specific object dictionary entries related to control words, status words, and operation modes.
Position Sensor Group: The manual briefly mentions the position sensor group, indicating further details on units and configurations.
Specifications: The document outlines the communication profile for CD1-k CANopen, focusing on Process Data Objects (PDOs) and Service Data Objects (SDOs). It specifies that at least 180 ms are necessary for the
servo-drive to start synchronization. The document details the structure and parameters of PDOs, including communication parameters and mapping.
Procedures: The initialization procedure involves configuring all device parameters, starting the transmission of SYNC, and setting all nodes to the operational state. The NMT state machine defines the communication status, transitioning through states such as Initialization, Pre-operational, Operational, and Stop.
Standards and Norms: The document adheres to the CANopen communication standards, specifically DS-301 and DSP-402 for device functionality. It describes the object dictionary structure, including device type, error register, and manufacturer information.
Recommendations: For effective communication, the document recommends ensuring the accuracy of the SYNC period to be better than 0.3%. It also advises on the proper configuration of communication cycle periods and synchronous window lengths.
Key Data and Parameters: - PDOs are defined by communication parameters and mapping. - Transmission types include synchronous, asynchronous, and event-driven modes. - Emergency objects consist of an 8-byte telegram with specific error codes. - The object dictionary includes various objects like device type, error register, and manufacturer details.
Limitations: The document specifies that modifications to COB-ID must not occur in the NMT Operational State without a Reset_Communication. It also notes that certain objects cannot be accessed via SDO.
Best Practices: Ensure proper synchronization and configuration of communication parameters to avoid errors. Regularly update the cycle period adjustment limit to maintain synchronization accuracy.
Communication Profile Overview: Receive PDO Communication Parameters: 1.
1st Receive PDO (RPDO1): COB-ID: Default 200h + Node-ID, Transmission Type: Default 253
2.
2nd Receive PDO (RPDO2): COB-ID: Default 300h + Node-ID, Transmission Type: Default 253
3.
3rd Receive PDO (RPDO3): COB-ID: Default 400h + Node-ID, Transmission Type: Default 1
Receive PDO Mapping: 1.
1st Receive PDO Mapping: Mapped Object: Control Word (60400010h)
2.
2nd Receive PDO Mapping: Mapped Object: Target Velocity (60FF0020h)
3.
3rd Receive PDO Mapping: Mapped Object: Interpolated Data Record (60C10120h)
Transmit PDO Communication Parameters: 1.
1st Transmit PDO (TPDO1): COB-ID: Default 180h + Node-ID, Transmission Type: Default 253
2.
2nd Transmit PDO (TPDO2): COB-ID: Default 280h + Node-ID, Transmission Type: Default 253
3.
3rd Transmit PDO (TPDO3): COB-ID: Default 380h + Node-ID, Transmission Type: Default 1
Transmit PDO Mapping: 1.
1st Transmit PDO Mapping: Mapped Object: Status Word (60410010h)
2.
2nd Transmit PDO Mapping: Mapped Object: Velocity Value (606C0020h)
3.
3rd Transmit PDO Mapping: Mapped Object: Actual Position Value (60640020h)
Device Profile Overview: PDO Mapping: 1.
Receive PDO: Control Word, Target Velocity, Interpolation Data Record, RPDO1 and RPDO2 are acyclic; RPDO3 is cyclic and synchronous.
2.
Transmit PDO: Status Word, Velocity Value, Actual Position, TPDO1 and TPDO2 are remotely requested; TPDO3 is cyclic and synchronous.
Common Entries in the Object Dictionary: 1.
Motor Type (6402h): PM
Synchronous motor2.
Motor Data (6410h): Includes parameters like Motor Id, Number of Motor Pole Pairs, Phase Order, etc.
3.
Supported Drive Modes (6502h): Includes Profile Position Mode, Profile Velocity Mode, etc.
4.
Drive Manufacturer (6504h): 'Infranor'
5.
Drive Data (6510h): Includes Drive Family Code, Drive Voltage, etc.
6.
Digital Inputs (60FDh): Includes Negative Limit Switch, Positive Limit Switch, etc.
7.
Digital Outputs (60FEh): Includes Physical Outputs and Bitmask.
Device Control: Drive State Machine: Describes the status and control sequence of the drive.
Control Word (6040h): Includes functions like Switch On, Disable Voltage, Quick Stop, etc.
Overview: The document provides a detailed technical description of the CD1-k CANopen Communication Profile, focusing on various operational modes, status indicators, and configuration parameters for motor control systems.
1. Status Word (Object 6041h): This section outlines the status word, which indicates the current status of the drive. Key bits include readiness to switch on, operation enabled, fault status, and specific operation modes. The status word can trigger device event transmissions.
2. Quick Stop Option Code (Object 605Ah): Defines actions for quick stop scenarios, such as disabling the drive or slowing down using speed ramps or current limits. The default action is to slow down on the current limit.
3. Mode of Operation (Object 6060h): Describes various operational modes like Profile Position Mode, Profile Velocity Mode, Torque Profile Mode, Homing Mode, and Interpolated Position Mode. The current mode is displayed in Object 6061h.
4. Position Sensor Group: Discusses the configuration of position sensors, including resolver and encoder inputs. It covers the selection and scaling of sensors for motor feedback and secondary sensor applications.
5. Profile Position Mode: Involves a trapezoidal trajectory generator for executing positioning with parameters like target position, profile speed, and acceleration. Key objects include Target Position (607Ah), Max Motor Speed (6080h), and Profile Velocity (6081h).
6. Object Dictionary Entries: Lists various objects with their attributes, data types, and default values. These include parameters for position resolution, encoder input selection, and motor feedback programming.
7. Encoder Configuration: Details the configuration options for different encoder types, including TTL, SIN/COS, and absolute encoders. It also covers encoder pulse interpolation and zero mark pitch settings.
8. Motor Feedback and Scaling: Explains the selection and programming of motor feedback sensors and the scaling factors for secondary sensors, which enhance position resolution.
Conclusion: The document provides comprehensive guidelines for configuring and operating the CD1-k system, emphasizing the importance of precise parameter settings for optimal motor control performance.
Overview: This document provides a detailed technical description of various objects and parameters related to the CANopen communication profile, specifically focusing on motion control and homing functionalities.
1. Specifications:- End Velocity (Object 6081h): Defines the end velocity with a default value of 0 and unit in increments per second (inc/s).
- Profile Acceleration (Object 6083h): Specifies the acceleration profile with a default value of 10000h, measured in increments per second squared (inc/s²).
- Profile Deceleration (Object 6084h): Similar to acceleration, with the same default value and unit.
- Motion Profile Type (Object 6086h): Determines the type of motion profile, either trapezoidal (0) or S-curve (-1), with a default value of 0.
2. Software Position Limit (Object 607Dh):- Defines minimum and maximum position limits for a linear axis, with a range from -231 to 231-1.
3. Position Control:- Position Window (Object 6067h): Sets a range of accepted positions around the target position, defaulting to 0.
- Position Modulo (Object 307Fh): Resets the position counter at a specified modulo value, defaulting to 0.
4. Homing Mode:- Homing Offset (Object 607Ch): Defines the position feedback value at the homing position.
- Homing Method (Object 6098h): Lists various methods for finding the homing position, with specific methods for different scenarios.
- Homing Speeds (Object 6099h): Specifies speeds during the homing process.
- Homing Acceleration (Object 609Ah): Sets the acceleration during homing, defaulting to 00010000h.
5. Position Control Function:- Position Actual Value (Objects 6063h and 6064h): Provides the current position value in increments.
- Position Loop Deadband (Object 3067h): Introduces a deadband around the position loop setpoint to manage specific applications.
- Following Error Window (Object 6065h): Defines the acceptable error range before triggering a fault.
6. Position Control Parameter Set (Object 60FBh):- Includes parameters like Proportional Position Gain, Feedforward Speed Gain, and others to fine-tune position control.
Conclusion: The document outlines the configuration and control parameters for motion and position control in a CANopen communication profile, providing detailed specifications and default values for each object.
Feedforward Terms and Gains
The document discusses feedforward terms used to reduce following errors during motor acceleration and deceleration phases. It specifies the data type as Unsigned16 with a value range of 0 to FFFFh and a default value stored in EEPROM. The feedforward speed gain is a combination of damping speed gain and feedforward friction gain, which helps cancel the load viscous friction effect.
Interpolated Position Mode
This mode is used for coordinated control of multiple axes, requiring trajectory generation by the host controller. The document details the synchronization of cycle times using SYNC messages and describes different interpolation modes: linear, PV cubic, and P3 cubic. Each mode has specific requirements for position and velocity data, with linear interpolation being optimal at very low speeds.
Object Dictionary Entries
The document provides detailed descriptions of various objects related to interpolation and velocity control, including their indices, data types, access permissions, and default values. Key objects include Interpolation Submode Select, Interpolation Data Record, and Interpolation Data Configuration.
Profile Velocity Mode
This mode allows operation with a velocity reference, closing only the speed and current loops. The document lists object dictionary entries for velocity control, including actual and demand values, velocity window and threshold settings, and target velocity. It also describes the ramp function and velocity control parameter set, detailing proportional, integral, and derivative gains.
Profile Torque Mode
In torque mode, the drive operates with current loops without speed or position control. The document outlines object dictionary entries for torque control, including target torque, torque slope, and torque control parameter set. It also describes the filtered current monitor and current monitor filter.
Current Monitor Filter
Index 3078h defines the current monitor filter with a range of 500 to 10,000 micro-seconds and a default value of 4000. It is accessible for read and write operations.
Stepper Emulation Mode
This mode is applicable for motors with a resolver for position feedback. It requires configuration of Pulse and Direction inputs. The mode is activated by setting object 6060 to -1. Key control and status bits include enabling pulse following and indicating pulse following status. Parameters such as motor speed and direction are controlled by input pulses and the Direction input logic state.
Electronic Gearing Mode
This mode synchronizes the servo motor with a master axis using a gearing ratio. It is activated by setting object 6060 to -2. Control and status bits manage motor gearing and offset profiles. Parameters include revolution increments and gearing ratio calculations based on sensor type.
Manufacturer Device Specific
Includes object dictionary entries for error and stop functions, current functions, inputs/outputs, position control, and more. Key objects include Drive Error Code (3020h), Warning Code (3021h), and Fault Reaction Masks (3330h, 3331h) which define error-triggered stops.
Error and Stop Function
Defines various objects for managing errors and stops, such as Drive Error Code, Warning Code, and Fault Reaction Masks. These objects specify conditions under which the motor will stop or slow down, including position limits, temperature warnings, and current limits.
Motor Temperature Sensor Monitor
This section describes the monitoring of motor temperature using a sensor. The threshold for warnings is calculated based on the equivalent resistance of the temperature value. The formula provided helps in determining the resistance, which is crucial for understanding the temperature sensor's specifications.
Current Functions- Current Offset (30D0h): Defines an offset for current output, useful for vertical axes. It is adjustable within a specified range and expressed as a percentage of amplifier rating.
- Current Limitation (30D1h): Sets a dynamic limit on current output, adjustable up to the amplifier's maximum current.
- Current Monitor (30D4h): Monitors motor current, relying on correct motor position for accuracy.
- I²t Monitor (30D5h): Calculates the motor RMS current value over the last 4 seconds, providing a percentage of the amplifier rating.
- Voltage Monitor (30E0h): Monitors motor voltage with specific data conversion values for different amplifiers.
Inputs/Outputs- Digital Inputs Bitmask (30FDh): Describes the default functions of digital inputs, which can be repurposed as simple digital inputs.
- Analog Inputs: Includes voltage and low-pass filter settings for analog inputs, with specific conversion and compensation procedures.
Position Control Function
This section details the calculation of motor position, including the use of internal raw position and position offsets. It explains how to handle motor shifts when the drive is out of logic supply and provides methods for calculating and adjusting position offsets.
Servo On/Off Timing Function
Defines the timing for enabling or disabling the drive via control words, including delays for servo loop output and motor brake reactions.
Position Capture Function
Describes the ability to capture motor and secondary sensor positions at a high rate using specific logic inputs, with configurations based on sensor feedback.
Capture Input Selection (Object 3389h): This section defines the configuration for capture inputs, allowing selection between CAPTURE and INDEX inputs, and between main and secondary capture sensors. The default value is set to 10h.
Capture Configuration (Object 3380h): This object configures the capture at rising or falling edges for two inputs. The default value is 0.
Capture Status (Object 3381h): This read-only object provides the status of capture events, including edge detection and signal status. It supports PDO mapping.
Capture Time Filter (Object 338Ah): Defines the time interval threshold for validating position capture, with a default value of 375 µs.
Capture Position Filter (Object 3382h): Sets a distance threshold for position capture, ensuring signal stability.
Capture 1 and 2 Position (Objects 3383h and 3384h): These objects return the latched positions for inputs 1 and 2, respectively, based on the capture configuration.
Single Shot Capture Command and Status (Objects 3385h and 3386h): These objects manage and display the status of single shot capture commands for rising and falling edges.
TPDO3 Control (Objects 33A0h and 33A1h): Controls the transmission mode for TPDO3, synchronizing with the SYNC message based on predefined control values.
Phasing Function (Objects 3410h and 3414h): Describes procedures for auto-phasing and motor phasing, requiring specific signatures to execute.
Auto-Tuning Function (Objects 3421h, 3430h, and 3420h): Details the auto-tuning process, including time interval selection, application requirements, and execution procedures with specific signatures.
Encoder Output (Object 3487h): Configures encoder emulation output, including resolution, division ratio, deadband, zero pulse shift, and enabling/disabling output.
Cogging Torque Compensation (Object 3491h): This optional feature compensates for motor cogging torque, requiring specific factory equipment and prior acquisition procedures.
Cogging Torque CompensationObject Code: VAR
Data Type: Unsigned16
Access: Read/Write
Default Value: EEPROM
Bit 8 controls Cogging Torque Compensation, where 0 disables and 1 enables it.
Cogging Torque Acquisition ProcedureIndex: 3492h
Data Type: Unsigned32
Access: Write Only
To execute, write the signature 'coga' to this object.
Digital Cam ConfigurationIndex: 2500h
Cam Configuration Register with 4 sub-indexes:
- Cam Enable Register: Enables corresponding cam.
- Cam Polarity Register: Sets cam output polarity.
- Cam Type Register: Defines cam type (0 for 1 position, 1 for 2 positions).
- Cam Hysteresis Register: Defines cam position hysteresis.
Index: 2501h
Defines positions for each cam, with 20 elements for 10 cams.
Cam StatusIndex: 2502h
Data Type: Unsigned16
Access: Read Only
Outputs the status of each cam.
Absolute Encoder FeedbackIndex: 3216h
Defines encoder increments per revolution and revolutions for multi-turn encoders.
Index: 3215h
Absolute position reset procedure with signatures 'razp' and 'setp' for resetting and centering.
Index: 3219h
Defines encoder absolute position offset.
Index: 3218h
Defines maximum absolute position value.
SinCos Inputs CalibrationIndex: 3496h
SinCos inputs error compensation procedure with signature 'scmp'.
Communication and Object DictionaryIncludes various communication parameters and object dictionary entries for device configuration and operation.
Overview: This document provides a comprehensive guide on the CD1-k CANopen Communication Profile, focusing on the Object Dictionary List and a Quick Start guide for Infranor Servo Drives.
Object Dictionary List:
- Device Control: Includes control and status words, mode of operation, and quick stop option code.
- Position Sensor Group: Details on polarity, position resolution, encoder input selection, and motor feedback programming.
- Profile Position Mode: Covers target position, motor speed, profile velocity, acceleration, and deceleration parameters.
- Homing Mode: Describes home offset, homing method, speeds, and acceleration.
- Position Control Function: Includes position actual value, following error window, and position control parameter set.
- Interpolated Position Mode: Discusses interpolation submode, data record, and configuration.
- Profile Velocity Mode: Details velocity sensor values, demand, and control parameters.
- Profile Torque Mode: Covers target torque, torque slope, and control parameters.
- Manufacturer Specific: Includes cam configuration, drive error codes, and sensor feedback.
Quick Start Guide:
- Installation: Involves wiring, powering, and commissioning using VDSetup software. Important to disable CAN bus during setup and store parameters in EEPROM.
- Operation: Primarily runs in interpolated position mode. Steps include starting communication (NMT), setting communication parameters (SDO), starting synchronization (SYNC), and data exchange (PDO).
- Communication Parameters: Key parameters include communication cycle period and synchronous window length. Adjustments needed for interpolated position mode.
- Data Exchange: Involves position demand and current position values. Mapping of PDOs can be modified for other data exchanges.
- Servo Control: Controlled via control and status words, accessible through SDO or RPDO1/TPDO.
State Diagram Overview
The document provides a state diagram in section 3.3.1, detailing the sequence to enable a drive (servo on). The sequence involves sending a control word from the controller and receiving a status word from the drive, transitioning through various states: 'Switch On Disabled', 'Ready To Switch On', and 'Operation Enable'.
Drive State Transition
- Switch On Disabled: Control word xx00h, Status word x240h, Drive is disabled.
- Ready To Switch On: Control word xx06h, Status word x221h, Drive is disabled.
- Operation Enable: Control word xx0Fh, Status word x227h, Drive is enabled.
The transition from 'Switch On Disabled' to 'Operation Enable' must pass through 'Ready To Switch On'.
Error Handling
If an error occurs, the drive enters 'Fault Reaction Active' and then 'Fault' state. To exit 'Fault', a rising edge of bit 7 in the control word is required. After resetting the fault, the drive returns to 'Switch On Disabled'.
IP-Mode Activation
In 'Operation Enable', setting bit 4 of the control word activates IP-Mode, confirmed by bit 12 in the status word. The drive then follows the position demand value via RPDO3. A mismatch between position demand and current position when bit 4 is set will cause a following error.
Additional Considerations
Errors trigger an emergency message to the controller. The 'Fault' state is indicated by status word xxxFh, with error details in object 3020h.