This document contains proprietary information protected by
copyright. All rights are reserved. No part of this manual may be
reproduced by any mechanical, electronic, or other means in any
form without prior written permission of the manufacturer.
Disclaimer
The information in this document is subject to change without prior
notice in order to improve reliability, design, and function and does
not represent a commitment on the part of the manufacturer.
Under no circumstances will ADLINK be held liable to this
document.
In no event will the manufacturer be liable for direct, indirect,
special, incidental, or consequential damages arising out of the
use or inability to use the product or documentation, even if
advised of the possibility of such damages.
Environmental Responsibility
ADLINK is committed to fulfill its social responsibility to global
environmental preservation through compliance with the
European Union's Restriction of Hazardous Substances (RoHS)
directive and Waste Electrical and Electronic Equipment (WEEE)
directive. Environmental protection is a top priority for ADLINK.
We have enforced measures to ensure that our products,
manufacturing processes, components, and raw materials have as
little impact on the environment as possible. When products are at
their end of life, our customers are encouraged to dispose of them
in accordance with the product disposal and/or recovery programs
prescribed by their nation or company.
Trademarks
Product names mentioned herein are used for identification
purposes only and may be trademarks and/or registered
trademarks of their respective companies.
Preface iii
Conventions
Take note of the following conventions used throughout this
reference to make sure that users perform certain tasks and
instructions properly.
Additional information, aids, and tips that help users perform
tasks.
NOTE
NOTE
Information to prevent minor physical injury, component
damage, data loss, and/or program corruption when trying to
CAUTION
WARNING
complete a task.
Information to prevent serious physical injury, component damage, data loss, and/or program corruption when trying to
complete a specific task.
ivPreface
AMP-204C / AMP-208C
Contents
Revision History...................................................................... ii
Preface.................................................................................... iii
List of Figures........................................................................ ix
List of Tables........................................................................ xiii
Table 4-4:Motion kernel signal table ............................................ 149
List of Tables xiii
xivList of Tables
AMP-204C / AMP-208C
1Introduction
The AMP-204C / AMP-208C, is a fully in-house developed
DSP-based advanced motion control card from ADLINK. It
supports 4/8 axis pulse type signal commands, provides
open-loop circuit control options, and supports position commands
for several different servo drives.
AMP-204C / AMP-208C exchanges data with operating system
through high speed PCI bus including motion control command,
feedback data, parameter, etc. Used with the ADLINK exclusive
Softmove kernel, it offers scores of move control functions
including T/S speed profile planning, point-to-point movement,
multi-dimension interpolation, and master/slave motion.
The AMP-204C / 208C, see Figure 1 below for its system functions,
uses one digital signal processor (DSP) from Texas Instrument (TI)
as its main computing unit and integrates high speed large volume
Field Programmable Gate Array (FPGA) to provide high speed
encoder output, 2/4 high speed position compare and trigger output,
move & general purposed I/O and logic control. It separates
isolation circuit into exclusive terminal board DIN-825-GP4 to
prevent the burning out of AMP-204C/208C from incorrect wiring.
Thanks to full range of flexing resistant wires from ADLINK, it
connects with market avaialble popular servo dirves easily.
Introduction 1
SCSI 100P
PCI Bus
PCI Bus
Isolation
DSUB 37P
DIN-825-GP4
Figure 1-1: AMP-204C/208Csystem block diagram
Graphical motion control interface – MotionCreatorPro 2 is a
Windows-based motion control software development tool for
motion control and I/O status monitoring. It captures motion curves
and data at the same time for analysis. Its Setup Wizard guides
you through the hardware installation and wiring as well as
single-axis manipulation step-by-step. This saves your
development time and cost.
2Introduction
AMP-204C / AMP-208C
The Windows Programming Libraries supports Windows coding
environment including: Visual Studio C++ 6.0, Microsoft .NET
framework based VB.NET and C++, and Borland's C++ Builder.
There are sample programs available in the installation folders.
The flow chart below will guide you in using this manual as well as
help you to locate any required information effectively.
Hardware installation
Wiring and jumper setup
Set up card and adjust axis parameters
with MotionCreatorPro 2
Control axis with MotionCreatorPro 2
Develop application with APS library
No
Is the system running
successfully?
Yes
Chapter II and III
MotionCreatorPro 2
User's Manual
Chapter IV
MotionCreatorPro 2
User's Manual
APS and ADCNC
library
End
Figure 1-2: System installation flow chart
Introduction 3
1.1Product Specifications
ItemDescription
Bus informationPCI Rev. 2.2, 33MHz
System
DSP
Board-to-board
interface
Motion control
I/O interface
General
purpose digital
I/O
PCI bus width32-bit
PCI bus voltage3.3V, 5V
PCI bus IRQ settingsAssigned by PCI controller
ModelTI 375MHz floating DSP
Memory (for program and
data)
Connector
Number of axes supported
Track update rate
Position / speed command
range
Acceleration / deceleration
range
Encoder input frequency20 MHz @ 4x AB
Encoder input mode
Encoder input interface±12 volts, TTL compatible
Motion control relevant I/O
Drive relevant I/O
General purpose I/O
DDR2 SDRAM: 64Mx16bit
Flash ROM: 16M-bit
1x SCSI-II 100P for
AMP-204C
1x Dual SCSI VHDCI 100P
AMP-208C
for
4/8 axis for AMP-204C /
AMP-208C
500us, 1ms, 2ms
(programmable)
32 bit
32 bit
CW/CCW, 1x/2x/4x AB
Phase
Plus/Minus end limitsignal
Zero-position for each axis
Servo ON
In-position signal /
AMP-204C / AMP-208C supports Windows XP/7 32/64 bit
operating system and provides a complete function library and
DLL files for easy application development by users.
1.2.2MotionCreatorPro 2
MotionCreatorPro 2 is a user interface exclusively developed for
ADLINK motion control products in common Windows
environment. You may easily set up card and axis parameters with
the help of MotionCreatorPro 2. Its Setup Wizard guides you
through the hardware installation and wiring as well as single-axis
manipulation in couple of minutes. MotionCreatorPro 2 not only
effectively reduces your development time but also enables you to
concurrently validate the overall mechanism and electric design
with all its single axis and interpolation motion operation pages.
1.3Terminal Board
ADLINK's exclusive terminal board DIN-825-GP4 for
AMP-204C/208C can connect with market available servo drivers
with special cables, e.g. Mitsubishi's J3A and Yaskawa's Sigma V
series, or with third party's servo or stepper drivers by single
ended open cables. Brands with exclusive cables support are
listed below:
Pulse command:
CableSupported brands
HSL-4XMO-DMMitsubishi J2S series
4XMO-DM-J3Mitsubishi J3A series
HSL-4XMO-DPPanasonic A4 and A5 series
HSL-4XMO-DYYaskawa Sigma V series
4XMO-DADelta A2 series
4XMO-OPENGeneral purpose
Table 1-1: Cross-reference table of exclusive cables for pulse servo drive
8Introduction
AMP-204C / AMP-208C
2Getting Start with The Installation
This chapter teaches you how to install AMP-204C / AMP-208C
hardware and software as well as its I/O wiring.
• Package Contents
• Hardware installation
• Software installation
• I/O wiring
2.1Package Contents
In addition to this manual you shall find the following item in the
product package box:
• One AMP-204C or AMP-208C card
• IDE 44p – DSUB 37p flat cable x 1
• Product warranty card x 1
Should there be any item missed or damaged, please consult with
your dealer immediately. Please keep the product along with items
included in its package for easy replacement or repair.
Getting Start with The Installation 9
2.2AMP-204C / AMP-208C Exterior Profile Diagram
SW2
P1
P2
Dimension in unit of millimeter (mm).
NOTE
NOTE
Figure 2-1: AMP-204C exterior profile diagram
P1: for Motion control command, Position feedback, and Servo I/O
feedback. (with SCSI 100-PINS connector)
P2:
for 16 channel digital TTL I/O. (with DSUB 37-PINS connector)
SW2:
Card ID setup (0-15)
10Getting Start with The Installation
AMP-204C / AMP-208C
P1
SW2
P2
Figure 2-2: AMP-208C exterior profile diagram
P1: for Motion control command, Position feedback, and Servo I/O
feedback. (with SCSI-VHDCI 200-PINS connector)
P2:
for 16 channel digital TTL I/O. (with DSUB 37-PINS connector)
SW2: Card ID setup (0-15)
Getting Start with The Installation 11
2.3Hardware Installation
2.3.1Hardware Configuration
AMP-204C/208C employs PCI Rev. 2.2 bus. System BIOS can
auto configure memory and IRQ channel.
Exclusive terminal board DIN-825-GP4 provides isolation circuit
and indicator lights for easy connections to varieties of servo drive
and stepper drive.
2.3.2Installation Procedures
1. Please read this manual carefully and set up signal I/O in
proper mode.
2. Turn off power of your computer and all relevant terminal
boards, insert your AMP-204C/208C to any 32-bit PCI
slot in your computer. (The slot is usually in white color.)
(Please make sure you have proper ESD (Electrostatic
discharge) protection.)
3. Connect AMP-204C/208C and DIN-825-GP4 with SCSI
100p cable
4. Set up motion control relevant limit switch on
DIN-825-GP4 board, servo signal and general purpose
digital signal wiring
5. Set up servo or stepper drive connection
6. Turn on system power including computer power,
terminal board relevant powers, and 24Vdc power
7. Verify all I/O signal and servo operation correctness with
MotionCreatorPro 2
Please ground the shielding end of the power terminal to the
earth to reduce risk of electric shock and ensure product
CAUTION
CAUTION
12Getting Start with The Installation
operation of your electric appliances.
Please disconnect the motor drive from its load before using
the card for the first time to protect your safety. Do not connect
the motor drive to any mechanical devices before the
completion of the installation and fine tuning of the control
system. Connect the system only after the board is adjusted
and the drive parameters can control the motor. Serious
damage may be resulted in otherwise.
AMP-204C / AMP-208C
2.3.3Troubleshooting
If the computer cannot power on normally or the motion control
system operates abnormally after system installation, please
follow steps described below for troubleshooting. If the problem
persists after you have taken steps described, please consult the
dealer where your product is purchased for technical services.
Abnormalities you
encountered
The card does not show up in
Windows Device Manager
after its driver has been
installed
MotionCreatorPro2 cannot
open after installing driver in
computer.
The without signal indicator on
MotionCreatorPro2 lights up
after the motor is connected
and the motor does not work.
When using the
MotionCreatorPro2 all the
control indicators of the drive
light correctly but the drive
warns
Value of output command
differ from the feedback value
from encoder
If motion control, the motor
moves only in one direction
rather than back and forth two
way movement
Potential causes
Please turn off your computer,
ensure the card is properly in PCI
slot and the driver is properly
installed by cheking its proper
installation in Windows Control
Panel's "Add remove programs"
Ensure .NET framework v3.5 or later
version has been installed in your
system
Please ensure a 24Vdc power is
connected to the terminal board
Please ensure correctness of the
axis parameter setup, alarm logic
(ALM) and the EMG loop
configuration
Please ensure feedback signal
(CW/CCW, 1xAB, 2xAB, 4xAB)
settings comply with that of the drive
Please ensure setting of signal pattern
(CW/CCW, OUT/DIR) comply with that
of the motor
drive
Getting Start with The Installation 13
2.4Software Installation Procedure
Windows driver installation procedure:
Step 1. Execute AMP-204C / AMP-208C WDM file and run
installation procedure automatically.
Step 2. Click "Next" as prompted to complete the installation
process.
14Getting Start with The Installation
AMP-204C / AMP-208C
Step 3. Restart your computer after installation is completed.
Step 4. Ensure the Windows Device Manager identify your
91001
101010
111011
121100
131101
14111 0
151111 ( d efa u lt)
Getting Start with The Installation 23
2.7IDE 44p – DSUB 37p Bus
This card include one IDE cable from IDE 44 pin to DSUB 37 pin.
It is used for AMP-204C / AMP-208C P2 extension 16 channel
digital input and 16 channel digital output.
24Getting Start with The Installation
AMP-204C / AMP-208C
2.8Exclusive Board - DIN-825-GP4
The "DIN-825-GP4" terminal board is designed for PCI-8254 /
PCI-8258 and AMP-204C / AMP-208C exclusively. It connects
with market available servo drives with special cables, e.g.
Mitsubishi's J3A and Yaskawa's Sigma V series, or third party's
servo or stepper drives with single end open cables.
The DIN-825-GP4 board supports both PCI-8254 / PCI-8258
and AMP-204C / AMP-208C. DO NOT connect it to other
CAUTION
ADLINK's motion controllers as it may be damaged.
Main connector
(to PCI board)
Brake signal
Motion I/O signals
Analog commands
(Torque Control)
Analog input signals
Power &
EMG signal
Pulse commands
(Position Control)
Additional 16 Digital
output signals
Additional 16 Digital
Laser control signals
Figure 2-3: Exterior of DIN-825-GP4
I/O connector
(to PCI board)
input signals
Getting Start with The Installation 25
2.8.1Definitions to Connector
1. P1: This is one SCSI
100-PINS connector for
motion control signals.
2. CMA1–4: These are four
26-PINS connector for
connecting to servo
drive to do S/T mode
control and analog
CMA1
J4
CMA2
CMA3
CMA4
P1
control commands
output.
3. CMP1–4: These are four
26-PINS connectors for
connecting to servo
drive to do P mode
control or stepper drive
CMP1
CMP2
J3
CMP3
CMP4
S1
S2
J6
to output pulse control
commands. It may be
CN1
connected to Mitsubishi
J3A series, Yaskawa
Sigma II, III & V series,
IOIF2
IOIF3
and Panasonic MINAS
A4&A5 with exclusive
cables.
4. J1–J3: These are three
IOIF1
IOIF4
sets of 10-pins screw
lock connectors
(screwed series, Delta
P2
A2 series, or connection
to other servo or stepper
drivers with single end
open cables). It may be
connected to any analog
ALM_RST / DO: You may set this signal to general purpose
digital output signal (EDO) or alarm clearance function
NOTE
NOTE
(ALM_RST) by switch S1 or S2.
36Getting Start with The Installation
AMP-204C / AMP-208C
2.8.3S1, S2: EDO/ALM_RST Selection Switch
Reset servo drive
Reset servo drive
Reset servo drive
Reset servo drive
DIN-825-GP4 is equipped with 4 servo drive reset signals. You
may set up CMA1~CMA4 PIN 10 and CMP1~CMP4 PIN 10 for
servo drive rest or J6 connector DO.1~DO.4 by switch S1 and S2.
Getting Start with The Installation 37
38Getting Start with The Installation
AMP-204C/AMP-208C
3Signal Connection
AMP-204C / AMP-208C must connect to servo or stepper motor
drive with exclusive terminal board DIN-825-GP4. All optical
isolation circuit of mechanical relevant I/O and servo relevant I/O
are set to DIN-825-GP4 to prevent damages to primary controller
AMP-204C / AMP-208C from any invalid signal connection to it.
This may effectively reduce difficulites and times required in
replacing controller relevant products when doing customer
service maintenance tasks. See sections below for detailed
descriptions on precautions required to connect to various
mechanical I/O and servo I/O signals. Contents:
Section 3.1: Pulse Command Signal
Section 3.2: Encoder Input Signal
Section 3.3: Emergency Stop Signal
Section 3.4: Mechanical Limit Switch Signal
Section 3.5: Original Position Switch Signal
Section 3.6: In-position/Zero Speed Signal
Section 3.7: Servo Alarm Signal
Section 3.8: Servo On Signal
Section 3.9: Comparing Trigger Signal
Section 3.10: General Purpose Digital Input and Output Signal
Signal Connection 39
3.1Pulse Command
AMP-204C / AMP-208C can provide 4/8 pulse control command
channel with each of them supports up to 6.5MHz output
frequency.
In general, you may set the servo driver to P (position) mode for
open-loop control with AMP-204C / AMP-208C pulse control
commands.
In addition to servo drive, the Stepper drive also employs pulse
command interface as the primay control input commands. See
below for corresponding pins of pulse command output against
differential pulse signals to DIN-825-GP4:
Either servo motor drive or stepper motor drive employs one of the
two input interfaces described below:
1. Line Driver input interface provides better anti noise-resistant
and longer wiring length.
• Signal connection diagram:
Figure 3-1: Line Driver type pulse control command signal connection
example
2. Open-Collector input interface can increase passing
current capacity of signal by adjusting pull-up resistance
value at the shorter wiring length.
Signal Connection 41
• Signal connection diagram:
Figure 3-2: Open-Collector type pu lse cont rol c ommand sign al conn ecti on
example
To avoid damages to Line Driver components on controller
casued by invalid wiring please connect the OUT-, DIR- pins of
CAUTION
controller to OUT, DIR pins of motor drive.
The controller employs Line Driver component -26LS31 with
maximum Sink Current at 20mA. Do not use it at current above
CAUTION
this value, the component may be damaged otherwise.
42Signal Connection
AMP-204C/AMP-208C
3.2Encoder Input, EA & EB & EZ
AMP-204C / AMP-208C provides 4/8 encoder input channels
respectively which accept single end input frequency up to 5MHz
with each channel containing EA, EB, and EZ signal. Each group
of EA, EB, and EZ signal contains a pair of differential signal, e.g.
the EA signal contains EA+ and EA-. See Section 4.1.1.4 for how
to use the encoder. See below for corresponding pins of encoder
input on DIN-825-GP4:
The controller employs Line Receiver component -26LS32 with
maximum Sink Current at 20mA@5V. Do not use it at current
CAUTION
above this value, the component may be damaged otherwise.
Axis #
Signal Connection 43
• Signal connection diagram:
Figure 3-3: Line driver type encoder input signal connection example
44Signal Connection
AMP-204C/AMP-208C
3.3Emergency Stop Input
AMP-204C/ AMP-208C provides one hardware input emergency stop
signal (EMG). If the external emergency stop signal is triggered, all
motion control commands will be stopped immediatly. In addition, the
DIN-825-GP4 is designed to transmit external emergency stop signal
to servo/stepper motor drive to stop operation of every motor
immediately. See below for corresponding pins of emergency stop
signal input on DIN-825-GP4:
J5 Pin NoSignal NameDescriptionAxis #
5EEMG
External emergency stop input (external input)
-
CMPx / CMAx
Pin No (x=1~4)
19EMG(n)Emergency stop (output to drive)1~8
Signal Name
(n=1~8)
DescriptionAxis #
AMP-208C requires two DIN-825-GP4 for eight axes motion
control functions
Figure 3-4: Emergency stop signal connection example
Signal Connection 45
3.4PEL/MEL Input
AMP-204C / AMP-208C provides 4/8 End-limited switch input
channels. The Plus Limited Switch (PEL) is used as the
mechanical protection switch for movement in the positive
direction. When this switch is triggered the AMP-204C /
AMP-208C stops its positive direction movement immediately. The
Minus Limited Switch (MEL) is used as the mechanical protection
switch for movement in the negative direction. When this switch is
triggered, the AMP-204C / AMP-208C stops its negative direction
movement immediately. See below for corresponding pins of
mechanical limit switch signal input on DIN-825-GP4:
Figure 3-5: Mechanical limit switch signal connection example
Signal Connection 47
3.5ORG Input
AMP-204C / AMP-208C provides 4/8 original position switch input
channels. Working together with the home movement described in
Section 4.3, this function returns the body to its original position
(also known as the zero position). See below for corresponding
pins of original position switch signal input on DIN-825-GP4:
Figure 3-6: Original position switch signal connection example
48Signal Connection
AMP-204C/AMP-208C
3.6INP Input
AMP-204C / AMP-208C provides 4/8 In-position (INP) input
channels. Working with function described in Section 4.8, it can be
used as the trigger source for in-position events of individual
motion. In general, when servo drive is set to position mode (P
mode), the servo issues a (INP) pulse signal to controller when
movement get into position. See below for corresponding pins of
in-position or zero speed detection signal input on DIN-825-GP4:
CMPx
Pin No (x=1~4)
2INP(n)
Signal Name
(n=1~4)
In-position Input (for pulse output mode only)
AMP-208C requires two DIN-825-GP4 for eight axes motion
control functions
AMP-204C / AMP-208C provides 4/8 servo alarm input channels.
Working with function described in Section 4.11 it can be used as
the trigger source for motion interrupt event. In general, when
abnormality is encountered during servo drive movement, it issues
an (ALM) pulse signal to controller for abnormality occurrence.
See below for corresponding pins of servo alarm input on
DIN-825-GP4:
CMAx / CMPx
Pin No (x=1~4)
11ALM(n)Servo alarm input1~4
Signal Name
(n=1~4)
DescriptionAxis #
AMP-208C requires two DIN-825-GP4 for eight axes motion
control functions
AMP-204C / AMP-208C provides 4/8 servo-on output channels
and utilize the servo-on signal to enable servo drive for pulse or
analog commands input. If there is abnormality is encountered
during movement, the AMP-204C / AMP-208C turns off this signal
automatically and stops all motion control commands. See below
for corresponding pins of servo-on signal output on DIN-825-GP4:
CMAx / CMPx
Pin No (x=1~4)
1SVON(n)Servo-on output1~4
Signal Name
(n=1~4)
DescriptionAxis #
AMP-208C requires two DIN-825-GP4 for eight axes motion
control functions
AMP-204C / AMP-208C provides 2/4 comparing trigger pulse
output channels. Each comparing trigger channel can output pulse
commands up to 1 MHZ. See Section 4.9.2 for its detail and how
to use it. See below for corresponding pins of pulse command
output against differential pulse signals to DIN-825-GP4:
The compare trigger pulse output channel of AMP-204C /
AMP-208C employs line driver output interface for better noise
NOTE
NOTE
• Signal connection diagram:
signal resistance and wiring length where trigger output (3) &
(4) require #2 DIN-825-GP4 for wiring.
1. Line Driver interface:
Figure 3-10: Line Driver type compare trigger signal connection example
52Signal Connection
AMP-204C/AMP-208C
2. Open-Collector interface:
Figure 3-11: Open-Collector type compare trigger signal connection
example
Signal Connection 53
3.10 Digital Output/Input
AMP-204C / AMP-208C provides 20/24 digital output/input
channels. See below for corresponding pins of general purpose
digital input and output signals on DIN-825-GP4:
J1/J2 Pin No.Signal NameDescription
2EDI(3) / EDI (1) General purpose digital input signal (3), (1)
6EDI(4) / EDI (2) General purpose digital input signal (4), (2)
J6 Pin No.Signal NameDescription
1EDO(1)General purpose digital output signal (1)
2EDO(2)General purpose digital output signal (2)
3EDO(3)General purpose digital output signal (3)
4EDO(4)General purpose digital output signal (4)
AMP-208C requires two DIN-825-GP4 for eight axes motion
control Function
NOTE
NOTE
NOTE
NOTE
# 1 controls axes 1 ~ 4 and #2 controls axes 5~ 8
1. Please connect DICOM to external power
supply (24VDC in general) if possible.
2. Please connect DOCOM to ground (GND) of
external power supply if possible.
54Signal Connection
• Signal connection diagram:
AMP-204C/AMP-208C
Figure 3-12: General purpose digital I/O signal connection example
Signal Connection 55
IOIF1 Pin No.Signal NameDescription
1~8DI(1)~(8)General purpose IOIF2 digital input signal (1)~(8)
IOIF2 Pin No.Signal NameDescription
1~8DI(9)~(16)General purpose digital input signal (9)~(16)
IOIF3 Pin No.Signal NameDescriptionAxis #
※1~5
DO(1)~(5)
General purpose digital output signal
(1)~(5)
※The digital output current may reach 250mA
NOTE
NOTE
IOIF3 Pin No.Signal NameDescriptionAxis #
6~8DO(6)~(8)
General purpose digital output signal
(6)~(8)
-
-
IOIF4 Pin No.Signal NameDescriptionAxis #
1~8DO(9)~(16)
General purpose digital output signal
(9)~(16)
-
1. Please connect DICOM to external power supply
(24VDC in general) if possible.
NOTE
NOTE
2. Please connect DOCOM to ground (GND) of
external power supply if possible.
56Signal Connection
• Signal connection diagram:
AMP-204C/AMP-208C
Signal Connection 57
Figure 3-13: General purpose digi tal I/O signal connection example
58Signal Connection
AMP-204C / AMP-208C
4Motion Control Theory
This chapter introduces you the motion control function of
AMP-204C / AMP-208C as well as relevant precautions in using
them. Contents:
Section 4.1: Motion Control Mode and Interface Overview
Section 4.2: Motion Control Operations
Section 4.3: Home Move
Section 4.4: Velocity Move
Section 4.5: Jog Move
Section 4.6: Point-to-Point Move
Section 4.7: Interpolation
Section 4.8: Motion Status Monitoring
Section 4.9: Application Functions
Section 4.10: Safety Protection
Section 4.11: Host Interrupt
Motion Control Theory 59
AMP-204C / AMP-208C
4.1Motion Control Mode and Interface Overview
This section describes basic setups of AMP-204C and AMP-208C
before doing motion control and fundamental concepts of its core
operations.
4.1.1Motion Control Interface
4.1.1.1Control Mode and Output Interface
You may use the MotionCreatorPro2 application program to set
up these two output interface and save your desired setting in
non-volatile memory, the so-called ROM, of the controller for
automatic loading when the controller power on. You may use API
listed below to retrieve current settings to ensure their correctness.
APS_get_eep_curr_drv_ctrl_mode ()
4.1.1.2Pulse Type
You can use this control mode to control stepper motor or set it to
P control mode to control servo motor with pulse format signal
input. The output interface of controller is OUT / DIR [1..8] pins.
(Please refer Chapter 3 for detail.)
This is the so called open-loop or semi closed-loop control model
where the upper controller output position command in digital
pulse format signal to lower stepper motor or servo motor to form
a close-loop control in servo drive. In this mode, number of pulses
indicates actual distance traveled by the machine (vary with the
relation between mechanical shift and pulse) while the pulse
output frequency indicates speed of the machine traveling at (in
unit of pulse per second, PPS).
Motion Control Theory 60
AMP-204C / AMP-208C
In this mode users must pay special attention to pulse signal
format acceptable to the motor to be drived. The motor works
normally only when being drived by correct pulse format signal,
otherwise the motor may fail to work in erroneous direction or with
abnormal shaking. Users must correctly set up the controller
before any motion control after the software is initialized. This
controller provides two pulse signal output format:
• OUT / DIR signal format: At this mode, the OUT signal indicates
frequency and amount of output pulses where DIR indicates
direction of machine movement.
• CW / CCW signal format: At this mode the CW/CCW signal
indicates both machine movement direction and pulse output
frequency and amount
Counter:
Figure 4-1: Format of pulse signal
The signal format can be set up in axis parameters:
Param. No.Define symbolDescription
81h (129)PRA_PULSE_OUT_MODEPulse output format setup
Motion Control Theory 61
AMP-204C / AMP-208C
4.1.1.3Encoder
The positon encoder of this controller supports 9 kinds of digital
signal input formats as described below.
Please set up the position encoder before doing motion control. This is especially true for analog output type closed-loop
CAUTION
NOTE
NOTE
control as invalid setup may lead to motor burst.
You may set up and test your controller with MotionCreatoPro
2 software. You can check this by manually spinning the motor
(or move the workbench) and verify the encoder signal from
motor or linear scale to the controller.
No Decode Mode
0OUT/DIR (1)
1 CW/CCW (1)
21X AB
32x AB
44x AB
5OUT/DIR (2)
6OUT/DIR (3)
7OUT/DIR (4)
Positive directionNegative direction
EAEBEAEB
High
Low
High
Low
Low
Low
Low
Low
High
High
Motion Control Theory 62
AMP-204C / AMP-208C
No Decode Mode
8CW/CCW (2)
Positive directionNegative direction
EAEBEAEB
HighHigh
Table 4-1: Encoder input format
• Axis parameter setup:
Param. No.Define symbolDescription
80h (128)PRA_ENCODER_MODEEncoder input signal format
85h (133)PRA_ENCODER_DIREncoder counting direction setup
Table 4-2: Encoder input format
• Axis parameter setup API:
APS_set_axis_param (); // write in axis parameter
APS_set_axis_param (); // read out axis parameter
Motion Control Theory 63
AMP-204C / AMP-208C
4.1.1.4Motion Control I/O
Some motion control I/O signal of this controller definition are
summarized in table below:
Param.
0ALMInputServo alarm
1PELInputPlus end limit
2MELInputMinus end limit
3ORGInputHome input
4EMGInputEmergency stop input
5EZInputServo index input
6INPInputIn-Position input
7SVONOutputServo ON output status
Defined
Symbol
TypeDescription
Here ALM, EZ and INP are signals sent by servo drive and SVON
(Servo on) signal is the receiving signal of servo drive for driving
the servo motor.
And PEL, MEL, ORG and EMG are mechanical I/O signals. Safety
relevant signals, e.g. EMG, PEL and MEL are used to work
together with motion control. Take example, the home movement
will use ORG, PEL, MEL, EZ and other signals.
You may use following API functions to get I/O status with each bit
of the parameter representing status of the axis motion control I/O.
These signal logic may be inversed by software. Relevant axis
parameters are listed below:
• Board parameter
Param. No.Define symbolDescription
00h (0)PRA_EL_LOGICPEL/MEL input logic
01h (1)PRA_ORG_LOGICORG input logic
04h (4)PRA_ALM_LOGICSet ALM logic
05h (5)
06h (6)PRA_EZ_LOGICSet EZ logic
PRA_ZSP_LOGIC /
PRA_INP_LOGIC
Set INP logic
• Board parameter
Param. No.Define symbolDescriptionValueDefault
00h (0)PRS_EMG_LOGICEMG input logic 0: Not inverse
1: Inverse
0
•Filter
This controller features filters to screening out High-frequency
noise against motion control I/O to prevent abnormal motion
control action caused by external noise. The filter is defaulted
at ON status.
Motion Control Theory 65
AMP-204C / AMP-208C
4.1.2Control Cycle
In general, a motion controller features three control cycles for
different works. They are:
1. Servo control cycle
2. Motion control cycle
3. Host control cycle
4.1.2.1Servo Control Cycle
The servo control cycle is the time required to complete one close
loop control. Servo control cycle of this controller can be up to
20KHz, that is 50 microsecond for each cycle. In each control
cycle, the controller finish various servo control relevant jobs
including PID compensation and filter compensation.
4.1.2.2Motion Control Cycle
Default motion control cycle is set at 1KHz, i.e. 1 millisecond for
each cycle. Varieties of peripheral hardware components controls,
including host communication, trajectory calculation and data
sampling, are finished in it.
4.1.2.3Host Control Cycle
Default host control cycle is 0.5 KHz. That is, it takes 2 millisecond
to finish jobs in one control cycle including communications
between hosts, watch dog, kernel update, parameter management
and other non-realtime jobs.
The servo control cycle runs independetnly while the motion
control and host control cycle are done in the same processor. The
controller completes scheduled jobs automatically with the motion
control ones has higher priority than the host control one.
Motion Control Theory 66
AMP-204C / AMP-208C
Movement control
Elapsed time
System work
Elapsed time
Movement control
duration
Time
System work duration
Figure 4-2: Control cycle
The motion program is executed in motion control cycle to control
jobs to be executed in each motion control cycle directly for more
precise completion of realtime jobs. Please pay attention to DSP
loading when doing this.
Loading of CPU in controller is hard to predict as the controller is
affected by many factors, e.g. external signals, user operations, and
algorithm process during its operations. In most cases, please try to
keep CPU utilization rate to below 70% and reserve 30% of CPU
capacity to the processing of system jobs and momentary work loads.
Overloading (work loads exceed control cycle) may lead to
unpredictable results. This controller provides you with some
functions and tools to monitor processor utilization rate and adjust
control procedures. In case of any processor overloading, the
controller logs and warns (interrupt, plase refer to section of interrupt)
that you may take for proper responses in your program.
How to use API:
get_motion_control_timing () // get usage amount of current motion
control cycle
get_max_ motion_control_timing ()// get maximum usage amount
of motion control cycle
get_motion_control_timing () // get usage amount of current host
control cycle
get_motion_control_timing () // get maximum usage amount of host
This section describes motion control modes provided by the
controller and their operation principle. The objective is to help
users make most of the motion control capacity of your controller
to accomplish desired applications.
4.2.1Coordinated System
This controller employs Cartesian coordinate system where one or
more axes motion can be executed by one-to-one mapping each
axis to a motor. There exists a conversion relation between axis of
the Cartesian coordinate system and the motor being controlled.
This conversion relation enables users to set up their own
coordinate system without restricitons. Figure below indicates a
coordinate system relation. The unit conversion factor will be
reviewed in next section.
Coordinated
system
Command
Position(F64)
Feedback
Position(F64)
Unit
factor
Motor
coordinate
Command
counter (I32)
Encoder
counter (I32)
Servo loop
control
/
Pulse
generator
Motor
Figure 4-3: Controller coordinates system block
You may read out or set up coordinate command location or actual
coordinate location
In close loop control procedure you cannot set up command
counter and encoder counter and so relevant setup API are not
NOTE
NOTE
provided.
4.2.2Unit Factor
Location unit (or motion mechanism) of motor can have actual mapping
against physical distance unit of coordinate system by setting up proper
unit factor. The calculation formula is described below
(Deductor gear)
(Drive gear)
We use three examples to explain the way how unit factor is
calculated
Example 1: Ball screw carrier
Assume encoder counts (resolution) generated by one spin of the
motor is 10000 and the screw pitch is 10mm and the user desired
distance unit of measure is micrometer,
Gear Ratio
M:N = 1:2
Pitch = 10 mm
Motion Control Theory 69
Unit factor can be calculated as described below:
AMP-204C / AMP-208C
tinUrotcaf
Example 2: Conveyor system
Assume number of pulses generated by one spin of the motor is
8192, the conveyor belt shift 5cm by one spin of the belt pulley, the
gear ratio is 1:2, and the user desired distance unit of measure is
milimeter then the unit factor can be calculated as :
Motor
==
10000
100010
×
Picth= 5 cm
μ
2
2×
1
mmm
Unit factor can be calculated as described below:
2
×
mmcm
23867
.
1
0100
.
mmm
tinrotcaf=
U
Example 3: Linear Motor system with Linear Scale
Take optical resolution at 1 micrometer and distance at millimeter
then the unit factor should be:
U
Motion Control Theory 70
=
tinrotcaf=
5001
=
10001
μ
8192
×
1
×
AMP-204C / AMP-208C
Unit factor can be set up in axis parameter:
Param. No. Define symbolDescriptionValueDefault
86h (134)Unit factorF64 value1
In general, you should define unit of measure at first and set up
other position relevant parameter before designing any motion
control application.
If unit factor setting are changed during operation, other
parameters related with distance unit of measure (e.g. position,
NOTE
NOTE
velocity, and acceleration unit of measure) will be affected and
you are required to change and adjust relevant setting on your
own.
Relevant axis parameters can be found in table below:
Param. No.Define symbol
07h (7)PRA_SD_DEC
0Ah (10)PRA_SPEL_POS0
0Bh (11)PRA_SMEL_POS1
13h (19)PRA_HOME_ACC
15h (21)PRA_HOME_VM
17h (26)PRA_HOME_SHIFT
19h (25)PRA_HOME_VO
1Bh (27)PRA_HOME_POS
21h (33)PRA_ACC
22h (34)PRA_DEC
23h (35)PRA_VS
24h (36)PRA_VM
25h (37)PRA_VE
2Ah (42)PRA_PRE_EVENT_DIST
2Bh (43)PRA_POST_EVENT_DIST
43h (67)PRA_JG_ACC
44h (68)PRA_JG_DEC
45h (69)PRA_JG_VM
46h (70)PRA_JG_OFFSET
Some API may have encoder signal of position related input
parameter.
NOTE
NOTE
Motion Control Theory 71
AMP-204C / AMP-208C
4.2.3Acc/Deceleration Profile
Basic motion command usually contains distance, velocity, and
acceleration data. This controller plans and calculates Acceleration &
Deceleration profile based on these motion command parameters to
make motion operation completed as desired by users. This
controller provides following acceleration profiles:
1. Trapezoidal speed profile, T-curve
2. S-curve
4.2.3.1Trapezoidal Speed Profile, T-curve
Trapezoidal speed profile (the so called T-curve) is a curve
where the acceleration zone and deceleration zone matches
first-order linear speed profile (equivalent acceleration). As shown
in the velocity-time chart (V-T):
Velocity
Max. velocity
Acc.
Distance
Dec.
Start velocity
Acceleration
Max. acceleration
Max. acceleration
Jerk
Time
Time
Time
Figure 4-4: Relation of trapezoidal speed profile's speed/acceleration/jerk
VS time
Motion Control Theory 72
AMP-204C / AMP-208C
In a V-T chart the area under the trapezoidal curve equals motion
distance. If the user does not set up sufficient motion distance the
controller shall increase (decrease) the maximum speed while
maintian the acceleration, as shown in figure below:
Velocity
MaxVel
MaxVel’
Time
Figure 4-5: Maximum speed by auto-planning
MaxVel is the maximum velocity set up by user, dotted line
indicate speed profile with sufficient distance. As the movement
distance is insufficient, the controller adjust the maximum velocity
to MaxVel’ automatically. The acceleration and deceleration rate
remain intact to maintain the best (shortest) motion time.
Motion Control Theory 73
AMP-204C / AMP-208C
4.2.3.2S-curve
An S-curve is a curve where the speed profile in the jerk area can
be represented by second-order profile. This helps to reduce
motor vibration at start up and stop time as indicated by points (t1,
t3, t5, t7) in figure below.
To shorten acceleration and deceleration time the linear section
(t2, t6) is inserted in these area to maintain the maximum
accleration and so get an accleration-time (A-T) chart in
trapezoidal.
Velocity
Max. velocity
End velocity
Start velocity
Acceleration
Max. acceleration
Max. acceleration
Jerk
Acc.
Dec.
Distance
Time
Time
TaccTdec
Time
Figure 4-6: Relation of S-curve speed profile's speed/acceleration/jerk VS
time
Motion Control Theory 74
AMP-204C / AMP-208C
This controller employs S-factor (S) to control jerk ratio. Its
equation is described below
Value of S is between 0 and 1, when
S = 0, the speed profile becomes a T-curve
S >0 and S<=1: S - curve
When S = 1, the profile comes to a Pure S– curve
with its A-T
chart become a triangle.
The equation above indicate that the greater the value of S is the
more smooth the speed profile and the smaller jerk value will
become. This helps in reducing motor vibration. However, the
motion process takes more time to complete. On the contrary, the
smaller the S value is the greater the jerk value become and the
motion time reduces to the shortest.
As with a T-curve, when motion distance is insufficient, the
controller adjust the maximum velocity automatically to maintain
smooth movement. Acceleration ACC and DEC and S-factor
remain consistent to maintain acceleration rate and the jerk rate
will be changed, as shown in figure below
Motion Control Theory 75
Velocity
A
MaxVel
MaxVel
Start velocity
Acce.
cceleration
AMP-204C / AMP-208C
Time
Time
Jerk
Time
Figure 4-7: Auto-planning the maximum velocity
Acceleration profile and its rule described above applies with single axis
point-to-point movement (PTP), velocity movement, home movement,
and interpolation among multiple axis.
Motion Control Theory 76
• Relevant axis parameters
Param. No.Define symbolDescription
12h (18)PRA_HOME_CURVEHome move S-factor
20h (32)PRA_SFMove S-factor
42h (66)PRA_JG_SFJog S-factor
You may set up S-factor directly in some API, please refer to
Function library manual for detail.
NOTE
NOTE
AMP-204C / AMP-208C
Motion Control Theory 77
AMP-204C / AMP-208C
4.3Home Move
After power on and before executing any motion control, a motion
control system executes home movement to set up the zero
position of the coordinate system.
Commonly available stepper motor, servo drive or linear motor
mechanism accompanied by optical scale employs incremental
type encoder which requires some mechanical signal to set up the
original position during home operation. These mechanical signals
are ORG, EZ, PEL, and MEL. Some servo drives are featured with
absolute type encoder, e.g. J3-B type (SSCNET 3) of Mitsubishi,
that require at least one home movement after system
initialization. No more homing operation is required after the
absolute coordinate system is established.
After the homing command is received, the controller starts
searching for original position / zero position with the help of some
external signals. After the home movement is completed the
controller axis stops at the original postion while command
position and feedback position reset to zero. All the home
movement related operations are executed by the controller
automatically. No user interaction is required. Just wait it to
complete automatically.
You can finish home movement operation by steps described
below:
• Set up home mode and relevant parameters
• Start up home move
• Wait for home move to complete. (You may check the status by
polling or interrupt.)
• If home move does not complete successfully you may
troubleshooting by steps described below
msts = APS_motion_status( axis_id );// Get motion status
msts = ( msts >> MTS_NSTP ) & 1; // Get motion done bit
}while( msts == 1 );
// 4. Check home move success or not
msts = APS_motion_status( axis_id ); // Get motion status
msts = ( msts >> MTS_ASTP ) & 1; // Get abnormal stop bit
if( msts == 1 )
{ // Error handling ...
I32 stop_code;
APS_get_stop_code( axis_id, &stop_code );
}else
{ // Homing success.
}
}
AMP-204C / AMP-208C
Motion Control Theory 80
AMP-204C / AMP-208C
This controller provides multiple auto-home searching process for
different hardware platform which may refer to three mechanical
signals: ORG, EL, and EZ. You may define three homing mode
with these reference signal. User may design required homing
process by any combination of these three signals. Each mode
can have multiple parameters to meet various positioning
requirements. These three homing mode are desinged in
accordance with relevant system configurations and have included
commonly available hardware configurations. These three modes
are:
1. ORG signal homing (Home mode = 0) (Home return by ORG
signal)
2. EL signal homing (Home m ode = 1)
3. Single EZ signal homing (Home mode = 2)
Homing process and relavant parameters of these three modes
are described below.
4.3.1OGR Signal Homing - Home Mode = 0
There are three cases for this mode according to its initial position:
Condition A:The initial position is located between MEL and
ORG signals or at MEL signal.
Condition B: Ths initial position is located at ORG signal
Condition C: The initial position is located between PEL and
ORG signals or at PEL signal.
Table and figure below represent homing steps of these three
situations with their speed and position. The three gray area in
figure below represent the ON region of MEL, ORG, and PEL from
left to right respectively. Move forward at the highest speed VM to
search for ORG, decelerate to fully stop when ORG signal is
detected. Then move away from ORG signal in VM speed. Search
ORG again with low speed VO to complete the Home procedure.
Motion Control Theory 81
• Relevant axis parameters setup
AMP-204C / AMP-208C
Axis parameters
PRA_HOME_MODE0Employing home mode 0 (homing by ORG signal)
PRA_HOME_DIR0Homing by moving forward in positive direction
PRA_HOME_EZA0 Further align with signal EZ, 0: No, 1: Yes
PRA_HOME_S0S-curve factor
PRA_HOME_ACCACC
PRA_HOME_VSVSInitial speed in unit of (distance unit of measure/sec.)
PRA_HOME_VMVM
PRA_HOME_VOVOHoming speed in unit of (distance unit of measure/sec.)
PRA_HOME_SHIFT0
Axis
parameter
values
Description to axis parameter value
Acceleration and deceleration in unit of (distance unit of
measure/sec.
Speed of original postion searching in unit of (distance
unit of measure/sec.)
Shift amount of final homing position against alignment
signal (disantace unit of measure / pulse)
2
)
Condition A
Initial position
Condition B
Home
position
Condition C
Initial
Home position
position
VM: Home searching speedVO: Home approaching speed
Figure 4-8: Home mode 0 (Case: ORG)
Motion Control Theory 82
AMP-204C / AMP-208C
ORG signal of most mechanical device has two directional edges
(the two ends of signal fender). Figure above indicates that when
the homing direction parameter in axis parameters is set to
positive direction (PRA_HOME_DIR), the control axis starts
searching from positive direction (the ascending direction of
position command). And stops at the left edge of ORG signal
(close to MEL mechanical signal).
On the contrary, if the homing direction parameter in axis parameters
is set to negative direction (PRA_HOME_DIR), the control axis starts
seraching from negative direction (the descending direction of
position command). And stops at the right edge of ORG signal (close
to PEL mechanical signal). Figure below indicates home movement
when “PRA_DIR” is set to negative direction:
• Relevant axis parameters setup
Axis
Axis parameters
PRA_HOME_MODE0Employing home mode 0 (homing by ORG signal)
PRA_HOME_DIR1By negative direction forward homing
PRA_HOME_EZA0Further align with signal EZ, 0: No, 1: Yes
PRA_HOME_S0S-curve factor
PRA_HOME_ACCACC
PRA_HOME_VSVSInitial speed in unit of (distance unit of measure/sec.)
PRA_HOME_VMVM
PRA_HOME_VOVO
PRA_HOME_SHIFT0
parameter
values
Description to axis parameter value
Acceleration and deceleration in unit of (distance unit
of measure/sec.
Speed of original postion searching in unit of (distance
unit of measure/sec.)
Homing speed in unit of (distance unit of
measure/sec.)
Shift amount of homing position (distance unit onf
measure / pulse)
2
)
Motion Control Theory 83
Condition A
AMP-204C / AMP-208C
Home
Position
Condition B
Condition C
Initial position
Initial position
Home
position
VM: Home searching speedVO: Home approaching speed
Figure 4-9: Home mode 0 (Case: ORG)
When axis parameter PRA_HOME_EZA is set to 1 it means to
align with EZ, move forward to homing direction, until the first EZ
is detected and place control axis at the edge of EZ, then the
home movement is completed.
The motions are described below:
• Relevant axis parameters setup
Axis parameters
PRA_HOME_MODE0Home mode 0
PRA_HOME_DIR0Homing by moving forward in positive direction
PRA_HOME_EZA1Further align with signal EZ, 0: No, 1: Yes
PRA_HOME_S0S-curve factor
PRA_HOME_ACCACC
PRA_HOME_VSVSInitial speed in unit of (distance unit of measure/sec.)
Axis
parameter
values
Description to axis parameter value
Acceleration and deceleration in unit of (distance unit
of measure/sec.
2
)
Motion Control Theory 84
AMP-204C / AMP-208C
Axis parameters
PRA_HOME_VMVM
PRA_HOME_VOVO
PRA_HOME_SHIFT0
Axis
parameter
values
Condition A
Initial position
Condition B
and C
Description to axis parameter value
Speed of original postion searching in unit of (distance
unit of measure/sec.)
Homing speed in unit of (distance unit of
measure/sec.)
Shift amount of homing position (distance unit onf
measure)
Home position
Initial position
Home position
VM: Home searching speedVO: Home approaching speed
Figure 4-10: Home mode 0 (Case: ORG+EZ)
Figure below indicates a negative direction example:
• Relevant axis parameters setup
Axis parameters
PRA_HOME_MODE0Employing home mode 0 (homing by ORG signal)
PRA_HOME_DIR1By negative direction forward homing
PRA_HOME_EZA1 Further align with signal EZ, 0: No, 1: Yes
PRA_HOME_S0S-curve factor
Motion Control Theory 85
Axis
parameter
values
Description to axis parameter value
AMP-204C / AMP-208C
Axis parameters
PRA_HOME_ACCACC
PRA_HOME_VSVSInitial speed in unit of (distance unit of measure/sec.)
PRA_HOME_VMVM
PRA_HOME_VOVO
PRA_HOME_SHIFT0
Axis
parameter
values
Description to axis parameter value
Acceleration and deceleration in unit of (distance unit
of measure/sec.
Speed of original postion searching in unit of (distance
unit of measure/sec.)
Homing speed in unit of (distance unit of
measure/sec.)
Shift amount of homing position (distance unit onf
measure)
2
)
Condition A
Home
position
Condition B and
C
Initial position
Initial position
VM: Home searching speedVO: Home approaching speed
Figure 4-11: Home mode 0 adverse (Case: ORG+EZ)
You may set up homing position shift amount to fine tune the final
position. Figure and table below indicate an example of setup and
motion diagram.
Motion Control Theory 86
Loading...
+ hidden pages
You need points to download manuals.
1 point = 1 manual.
You can buy points or you can get point for every manual you upload.