Intelligent Motion Systems DSP-402 Homing Mode, Input Data Description, Output Data Description

Page 49

SECTION 7

Homing Mode

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.

control_word

homing_method

homing_speed

Homing

status_word

position_demand_value

Figure 7.1: The Homing Function

Input Data Description

The user can specify the speeds and the method of homing. There are two homing_speeds; in a typical cycle the faster speed is used to find the home switch and the slower speed is used to find the index pulse. The manufacturer is allowed some discre- tion in the use of these speeds as the response to the signals may be Dependent upon the hardware used.

Output Data Description

There is no output data except for those bits in the statusword which return the status or result of the homing process and the demand to the position control loops.

Internal States

There is only one internal state called homing which is reflected in the bits of the statusword.

Controlword (6040h) of Profile Position Mode

15

9

8

 

7

 

 

 

6

5

 

4

3

0

 

See 1.3

 

Halt

See 1.3

 

 

 

Reserved

 

Homing Operation Start

See 1.3

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

MSB

 

 

 

 

 

 

 

 

 

 

 

 

 

LSB

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Bit

 

 

Name

 

 

 

Value

 

Description

 

 

 

 

 

 

 

 

 

 

 

0

 

Homing Mode Inactive

 

 

 

4

 

Homing Operation

 

0

 

1

Start Homing Mode

 

 

 

 

 

 

Start

 

 

 

1

 

Homing Mode Active

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

1

 

0

Interrupt Homing Mode

 

 

 

8

 

 

Halt

 

 

 

0

 

Execute the instruction of bit 4

 

 

 

 

 

 

 

 

1

 

Stop motion

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Table 7.1: Homing Mode Bits of Controlword

Part 2: DSP-402 Implementation

41

Image 49
Contents Forcetm CANopen DSP402 Application Revision R020507 Contents Device Control Profile Position Mode Optional Application FE General I/O List of Figures This Page Intentionally Left Blank Application Guide MDrivePlus CANopen R020507 Can Message Format IntroductionMDrivePlus Architecture Profile Position Mode Section Homing Mode SectionProfile Velocity Mode Section Device ControlTrajectory Generator Objects and the Object DictionaryYes/No Xxxx h Index NamePDO Mapping DefaultCategory RangeIntentionally Left Blank Service Data Object SDO Accessing The MDrivePlus CANopenProcess Data Object PDO PDO AttributesDefault Mapping Example Consumer PDO PDO Mapping Procedure Consumer PDOPDO Mapping Consumer PDO1 RPDO1 1400h Object Description PDO ObjectsConsumer PDO1 RPDO1 1400h Entry Description 1600h Object Description Mapping ParametersConsumer PDO2 RPDO2 1401h Entry Description Consumer PDO2 RPDO2 1401h Object Description1601h Object Description Mapping Parameters 1601h Entry Description Mapping ParametersConsumer PDO3 RPDO3 1402h Entry Description Consumer PDO3 RPDO3 1402h Object Description1602h Object Description Mapping Parameters 1602h Entry Description Mapping Parameters1A00h Object Description Mapping Parameters Producer PDO1 TPDO1 1800h Entry Description1A00h Entry Description Mapping Parameters Producer PDO2 TPDO2 1801h Object Description1A01h Entry Description Mapping Parameters 1A01h Object Description Mapping ParametersProducer PDO3 TPDO3 1802h Object Description Producer PDO3 TPDO3 1802h Entry Description1A02h Entry Description Mapping Parameters Accessibility Codes Object 2000h I/O Discretes ConfigDiscretes UnsignedObject 2002h I/O Discretes Config 2002 h Config Input SwitchesObject 2004h Input Filter Mask Config 2006h Input Filter Time 2004hObject 2006h Input Filter Time ms See Entry Desc 2010h Analog Input2020h Software Limits as Unsigned Hardware2032 h Clock Options 2031 h Unit OptionsSee Table 2033 h Capture Input2205 h Hold Current % 2204 h Run Current %Object 2204h Run Current Percent Object 2205h Hold Current Percent2211h Options SettingInteger Point Target5002h FactoryAscii Ser. No 5003hControl and Status words State MachineState Machine Transitions Internal Unsigned16 6040 hObject 6040h Controlword Object 6041h Statusword StatuswordBits 12-13 Operation Mode Specific Bit 4 Voltage EnabledBit 5 Quick Stop Active Bit 7 Warning±Integer8 6060h Mode of OperationModes of Operation Object 6060h Modes of OperationObject 6061h Modes of Operation Display 6061 h Mode of Operation DisplayObject 6502h Supported Drive Modes = Mode Supported = Mode Not Supported Intentionally Left Blank General Information Profile Position ModeTrajectory Generator Input Data DescriptionSet-Point Transmission from Host Computer Functional DescriptionSingle Set-Point Mode Move After a Move 6040h Bit 5=0 Controlword 6040h of Profile Position ModePossible Integer 607A h Target Position6081 h Profile Velocity 6083 h Profile Acceleration 6082 h End Velocity6084 h Profile Deceleration Object 6086h Motion Profile Type 6086 h Motion Profile TypeInput Data Description Homing ModeOutput Data Description Internal States607C h Homing Offset Statusword 6041h of Homing ModeHoming Offset 607Ch ± Integer 6098 h Homing MethodPossible ± Integer Homing Method 6098hMethod 2 Homing on the Positive Limit Switch and Index Pulse Homing on the Negative Home Switch and Index Pulse Methods 7 to 14 Homing on the Home Switch and Index PulseMethods 17 to 30 Homing without an Index Pulse Methods 15 and 16 ReservedMethods 31 and 32 Reserved Methods 33 and 34 Homing on an Index Pulse 6099 h Homing SpeedsMethod 35 Homing on the Current Position Homing Speeds 6099hIntentionally Left Blank 6063 h Position Actual Value 6062 h6064 h Position Actual Value Position Control Function6066 h Following Error Timeout 6065 h Following Error Window6068 h Position Window Time Unsigned Mfg-SpecificControlword 6040h of Profile Velocity Mode Profile Velocity ModeStatusword 6041h of Profile Velocity Mode 606C h Velocity Actual Value60FF h Maximum Slippage 60FF h Target VelocityInteger Mfg-Specific Object 60FFh Target VelocityOptional Application FE General I/O 60FD h Digital InputsObject 60FDh Digital Inputs Object 60FEh Digital Outputs 60FE h Digital OutputsWarranty Excellence in Motion