Logosol 9122310174, Руководство пользователя

Страница: 56 / 60

Logosol Multifunctional Servo Drive LS-231g3SB
Doc # 712231005 / Rev. C, 09/13/2018
INITIALIZING PROCEDURE AND PROGRAMMING EXAMPLES FOR SERVO DRIVES
To ensure a proper operation of all Servo drives connected to the network, the following initializing
steps should be executed:
1. Reset all modules with Hard Reset command.
2. Set the addresses for all connected drives.
3. Set the individual gains (KP, KD, KI, IL, OL, CL, EL, SR and DB). Minimal requirements are:
KP <> 0, EL <> 0 and SR <> 0.
4. Use Load trajectory command to set the target position, velocity acceleration with start motion
now in trapezoidal mode. Minimal requirements are acceleration <> 0 and target position = 0.
This command does not start any motion. It is necessary to initialize internal registers of the
module.
5. Close the servo loop by using Stop Motor command (Pic_ae=1 and Stop abruptly=1).
Understanding the Serial Communication with Servo drives
The Serial Communication with Servo drives is strictly master-slave and matches repeatedly two
elements:
- Sending a command to the specified drive’s address;
- Receiving answer to the sent command – Status Byte(s).
Note: During the communication all bytes are sent with LSB first.
Commands
There are 16 commands managing Servo drives (refer to Command Description). Each command as
shown in the following two tables includes header, address, command, data bytes and one checksum
byte. Checksum does not include header byte.
Structure of Read Status command
Byte 1 Byte 2 Byte 3 Byte 4 Byte 5
Header Address
(Individual or
Group) Command Code Data Byte
CheckSum =
Byte 2 + Byte 3 +
Data Byte
High 4 bits
No. of data bytes Low 4 bits
command
code
AA 01 1 3 01 15
Examples
Cmd. Bytes Byte 1 Byte 2 Byte 3 Byte 4 – N Byte N+1
Command Header Address Cmd. Code Data Byte(s) Checksum
Reset position AA 01 0 0 01
Define status AA 05 1 2 05 1C
Set address AA 01 2 1 07 FF 21
Load trajectory AA 01 5 4 91 00 28 00 00 0E
Set gain AA 01 E 6 64 00 00 04 00 00 00 00 FF
00 00 08 01 00
57
Status Data
The structure of the returned status information depends on Define Status or Read Status commands
(refer to Command Description). By default only the Status byte and Checksum are returned to the
host.
Examples
Byte 1 Optional Bytes 0-16 CheckSum
Status Byte Additional Status Bytes as position, velocity, home
position, A/D auxiliary byte, version and position error. CheckSum = Byte 1+ Optional Bytes
09 no additional status bytes requested 09
09 00 28 00 00 – four additional status bytes 31
Logosol, Inc.
•
2833 Junction Ave., Ste. 101
•
San Jose, CA 95134
•
Tel: (408) 744-0974
•
www.logosolinc.com
56