Welcome to myCobot 320 Arm repository
1.Serial communication
Communication and Message Commands
Notice: It is not necessary to download the ATOM firmware before use, but when switching from Arduino to python programming, it is necessary to re-download the minirobot firmware "Transponder".
 | Please read the interface protocol document in detail and proceed with your program development after testing. |
|---|
1 Settings of USB Communication
*Make sure the following settings are prepared:*
Interface of mainline: USB Type-C connection PC and Basic
Port ratio: 115200
Data bit: 8
Parity bit: none
Stop bit: 1
2 Introduction to Command Frame & Sole Instruction
The main PC transmit data via M5Stakc-basic to peripheral PC. The peripheral PC decodes the data like commands with return values and then send the results back to the main PC within 500ms.
3 Formats of Message Commands' Sending and Receiving
Both sending and receiving should be represented in hexadecimal. Each command should contain 5 parts as shown below. Part 3 and 4 can be left a blank.
1 Pin of command: 0xFE 0xFE
Invariable
Indispensable
2 Effective lengthen:
Aggregated length including pin, serial number, functional codes and end
Indispensable
3 Serial number: 00 ~ 8F
Corresponding number of developed commands
You may leave it blank.
4 Functional codes:
Purpose-oriented
You may leave it blank.
5 End: 0XFA
Invariable
Indispensable
4 Explanation for Commands
The main PC transmit data via M5Stakc-basic to peripheral PC. The peripheral PC decodes the data like commands with return values and then send the results back to the main PC within 500ms.
| Type | Data | Length | Function |
|---|---|---|---|
| Command Frame | start bit: 0 | 1 | Head frame identification, 0XFE |
| start bit: 1 | 1 | Head frame identification, 0XFE | |
| bit of data length | 1 | Different commands correspond to different data length | |
| command bit | 1 | depending on different commands | |
| Command Frame | data | 0-16 | commands with data, depending on different commands |
| End Frame | end bit | 1 | stop bit, 0XFA |
5 Explanation for Sole-Instruction Commands
Powering up
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X10 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 10 FA
no return value
Power Decreasing and Connection Breaking up
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X11 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 11 FA
no return value
Checking the Status of Atom
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X12 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 12 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X12 |
| Data[4] | power on/off | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Given that Atom is powered on:
port return: FE FE 03 12 01 FA
Power Decreasing
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X13 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 13 FA
no return value
Robot System Checking: Normal
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X14 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 14 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X14 |
| Data[4] | connection/connection breaking up | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Given that Atom is successfully connected:
port return: FE FE 03 14 01 FA
Command Updating Mode (Interpolation Setting/Motion Mode Updating)
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X16 |
| Data[4] | connection/connection breaking up | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Setting updating motion mode:
Port transmission: FE FE 03 16 01 FA
Setting interpolation motion mode:
Port transmission: FE FE 03 16 00 FA
Free Mode (switch off torsion output)
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X1A |
| Data[4] | turn on/off | 01/00 |
| Data[5] | end frame | 0XFA |
Example:
Setting free motion mode:
Port transmission: FE FE 03 1A 01 FA
Checking whether free mode is set
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X1B |
| Data[5] | end frame | 0XFA |
Example:
Port return: FE FE 02 1B FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | command frame | 0X1B |
| Data[4] | turn on/off | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Given that Atom is in free mode:
port return: FE FE 03 1B 01 FA
Reading Angles (blocking information)
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X20 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 20 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: head frame | 0XFE |
| Data[1] | return value: head frame | 0XFE |
| Data[2] | return value: data-length frame | 0X0E |
| Data[3] | return value: command frame | 0X20 |
| Data[4] | high angle of No.1 steering gear | Angle1_high |
| Data[5] | low angle of No.1 steering gear | Angle1_low |
| Data[6] | high angle of No.2 steering gear | Angle2_high |
| Data[7] | low angle of No.2 steering gear | Angle2_low |
| Data[8] | high angle of No.3 steering gear | Angle3_high |
| Data[9] | low angle of No.3 steering gear | Angle3_low |
| Data[10] | high angle of No.4 steering gear | Angle4_high |
| Data[11] | low angle of No.4 steering gear | Angle4_low |
| Data[12] | high angle of No.5 steering gear | Angle5_high |
| Data[13] | low angle of No.5 steering gear | Angle5_low |
| Data[14] | high angle of No.6 steering gear | Angle6_high |
| Data[15] | low angle of No.6 steering gear | Angle6_low |
| Data[16] | end frame | 0XFA |
Example:
Return value of port: FE FE 0E 20 00 8C 00 3D FF E6 FF 3F 00 AF FF 51 FA
How to get the angle of joint 1:
temp = angle1_low+angle1_high*256
Angle1=（temp \ 33000 ?(temp – 65536) : temp）/100
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 100; if temp is less than 33000, then temp is divided by 100 directly.
Other joint angles are counted in a similar way.
Sending Sole Angle
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X06 |
| Data[3] | command frame | 0X21 |
| Data[4] | serial number of steering gear | joint_no |
| Data[5] | high angle | angle_high |
| Data[6] | low angle | angle_low |
| Data[7] | specified speed | sp |
| Data[8] | end frame | 0XFA |
Example:
Let the No.1 steering gear move to zero position
Port transmission: FE FE 06 21 01 00 00 14 FA
joint number: 1-6
angle_high: byte
counting method: angle value is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
angle_low: byte
counting method: angle value is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
no return value
Sending Entire Angles
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0F |
| Data[3] | command frame | 0X22 |
| Data[4] | high angle of No.1 steering gear | Angle1_high |
| Data[5] | low angle of No.1 steering gear | Angle1_low |
| Data[6] | high angle of No.2 steering gear | Angle2_high |
| Data[7] | low angle of No.2 steering gear | Angle2_low |
| Data[8] | high angle of No.3 steering gear | Angle3_high |
| Data[9] | low angle of No.3 steering gear | Angle3_low |
| Data[10] | high angle of No.4 steering gear | Angle4_high |
| Data[11] | low angle of No.4 steering gear | Angle4_low |
| Data[12] | high angle of No.5 steering gear | Angle5_high |
| Data[13] | low angle of No.5 steering gear | Angle5_low |
| Data[14] | high angle of No.6 steering gear | Angle6_high |
| Data[15] | low angle of No.6 steering gear | Angle6_low |
| Data[16] | specified speed | Sp |
| Data[17] | end frame | 0XFA |
Example:
Send 0 angle to entire joint, and let the steering gear move to zero position.
Port transmission: FE FE 0F 22 00 00 00 00 00 00 00 00 00 00 00 00 1E FA
angle1_high: byte
counting method: angle value is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
angle1_low: byte
counting method: angle value is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
Other angles are counted in a similar way.
no return value
Reading the Entire Coordinates
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X23 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 23 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: head frame | 0XFE |
| Data[1] | return value: head frame | 0XFE |
| Data[2] | return value: data-length frame | 0X0E |
| Data[3] | return value: command frame | 0X23 |
| Data[4] | specify high status of x coordinate | x_high |
| Data[5] | specify low status of x coordinate | x_low |
| Data[6] | specify high status of y coordinate | y_high |
| Data[7] | specify high status of z coordinate | z_high |
| Data[8] | specify low status of z coordinate | z_low |
| Data[9] | low angle of No.3 steering gear | Angle3_low |
| Data[10] | high angle of No.4 steering gear | Angle4_high |
| Data[11] | low angle of No.4 steering gear | Angle4_low |
| Data[12] | high angle of No.5 steering gear | Angle5_high |
| Data[13] | low angle of No.5 steering gear | Angle5_low |
| Data[14] | high angle of No.6 steering gear | Angle6_high |
| Data[15] | low angle of No.6 steering gear | Angle6_low |
| Data[16] | end frame | 0XFA |
Example:
Port return value: FE FE 0E 23 01 BC FD A0 10 15 DC 66 FF 54 DE 21 FA
How to get x coordinate:
temp = x_low + x_high*256
x coordinate =（temp\33000 ?(temp – 65536) : temp)/10
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 10; if temp is less than 33000, then temp is divided by 10 directly.
y coordinate is counted in a similar way.
How to get rx coordinate:
temp = rx_low + rx_high*256
x coordinate =（temp \ 33000 ?(temp – 65536) : temp）/100
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 100; if temp is less than 33000, then temp is divided by 100 directly.
y coordinate is counted in a similar way.
Sending Parameters of Sole Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X06 |
| Data[3] | command frame | 0X24 |
| Data[4] | axis | x/y/z/rx/ry/rz |
| Data[5] | specify high status of the parameters of xyz/rxryrz | xyz/ rxryrz_high |
| Data[6] | specify low status of the parameters of xyz/rxryrz | xyz/rxryrz_low |
| Data[7] | specified speed | Sp |
| Data[8] | end frame | 0XFA |
Example:
Given that the x coordinate is 200 and target speed is 20,
port transmission: FE FE 06 24 01 07 D0 14 FA
specified axis coordinate: byte
range: 1-6
data type of xyz_high: byte
counting method: value of x/y/z coordinate is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of xyz_low: byte
counting method: value of x/y/z coordinate is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
data type of rxryrz_high: byte
counting method: value of rx/ry/rz coordinate is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of rxryrz_low: byte
counting method: value of rx/ry/rz coordinate is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
no Return Value
Sending Parameters of Entire Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X10 |
| Data[3] | command frame | 0X25 |
| Data[4] | specify high status of x coordinate | x_high |
| Data[5] | specify low status of x coordinate | x_low |
| Data[6] | specify high status of y coordinate | y_high |
| Data[7] | specify low status of y coordinate | y_low |
| Data[8] | specify high status of z coordinate | z_high |
| Data[9] | specify low status of z coordinate | z_low |
| Data[10] | specify high status of rx coordinate | rx_high |
| Data[11] | specify low status of rx coordinate | rx_low |
| Data[12] | specify high status of ry coordinate | ry_high |
| Data[13] | specify low status of ry coordinate | ry_low |
| Data[14] | specify high status of rz coordinate | rz_high |
| Data[15] | specify low status of rz coordinate | rz_low |
| Data[16] | specifyd speed | Sp |
| Data[17] | mode | 0X01 |
| Data[17] | end frame | 0XFA |
Example:
Given that the coordinate of the end of robotic arm is （150.3，-68.7，101.8，10.18，0，-90）, and speed is 10,
port transmission: FE FE 10 25 05 DF FD 51 03 FA BC 30 00 00 DC D8 0A 01 FA
data type of x_high: byte
counting method: value of x coordinate is multiplied by 10 and get the hexadecimal highbyte
data type of x_low: byte
counting method: value of x coordinate is multiplied by 10 and get the hexadecimal highbyte
y coordinate is counted in a similar way.
data type of rx_high: byte
counting method: value of rx coordinate is multiplied by 10 and get the hexadecimal highbyte
data type of rx_low: byte
counting method: value of rx coordinate is multiplied by 100 and get the hexadecimal highbyte
ry coordinate is counted in a similar way.
no return value
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X26 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 26 FA
no return value
Judging Whether Program Stops
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X27 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 27 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X27 |
| Data[4] | suspend/not suspend | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Given that program suspends,
port return value: FE FE 03 27 01 FA
Program Restoration
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X28 |
| Data[4] | suspend/not suspend | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 28 FA
no return value
Program Stops
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X29 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 29 FA
no return value
Whether Reaching Specified Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0E/0X0F |
| Data[3] | command frame | 0X2A |
| Data[4] | high status of x coordinate/highbyte of angle of No.1 steering gear | x_high/Angle1_high |
| Data[5] | low status of x coordinate/lowbyte of angle of No.1 steering gear | x_low/Angle1_low |
| Data[6] | high status of y coordinate/highbyte of angle of No.2 steering gear | y_high/Angle2_high |
| Data[7] | low status of y coordinate/lowbyte of angle of No.2 steering gear | y_low/Angle2_low |
| Data[8] | high status of y coordinate/highbyte of angle of No.3 steering gear | z_high/Angle3_high |
| Data[9] | low status of z coordinate/lowbyte of angle of No.3 steering gear | z_low/Angle3_low |
| Data[10] | high status of rx coordinate/highbyte of angle of No.4 steering gear | rx_high/Angle4_high |
| Data[11] | low status of rx coordinate/lowbyte of angle of No.4 steering gear | rx_low/Angle4_low |
| Data[12] | high status of ry coordinate/highbyte of angle of No.5 steering gear | ry_high/Angle5_high |
| Data[13] | low status of ry coordinate/lowbyte of angle of No.5 steering gear | ry_low/Angle5_low |
| Data[14] | high status of rz coordinate/highbyte of angle of No.6 steering gear | rz_high/Angle6_high |
| Data[15] | low status of rz coordinate/lowbyte of angle of No.6 steering gear | rz_low/Angle6_low |
| Data[16] | coordinate/angle | 0X01/0X00 |
| Data[17] | end frame | 0XFA |
Example:
Judging whether robotic arm move to zero position:
port transmission: FE FE 0F 2A 00 00 00 00 00 00 00 00 00 00 00 00 00 FA
data type of x_high: byte
counting method: value of x coordinate is multiplied by 10 and converted into integral form to get the hexadecimal highbyte
data type of x_low: byte
counting method: value of x coordinate is multiplied by 10 and converted into integral form to get the hexadecimal lowbyte
y coordinate is counted in a similar way.
data type of rx_high: byte
counting method: value of rx coordinate is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of rx_low: byte
counting method: value of rx coordinate is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
ry coordinate is counted in a similar way.
data type of angle_high: byte
counting method: value angle is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of angle_low: byte
counting method: value of angle is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
Type: byte (temporarily unavailable)
Return Value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: head frame | 0XFE |
| Data[1] | return value: head frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X2A |
| Data[4] | reaching the point/not reaching the point | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Given that the robotic arm doesn't reach the point:
port return value: FE FE 03 2A 00 FA
Movement Check
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X2B |
| Data[4] | end frame | 0XFA |
Example:
port transmission: FE FE 02 2B FA
Return Value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: head frame | 0XFE |
| Data[1] | return value: head frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X2B |
| Data[4] | in motion/not in motion | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Given that the program is running:
port return value: FE FE 03 2B 01 FA
jog-Joint-Oriented Movement
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X05 |
| Data[3] | command frame | 0X30 |
| Data[4] | serial number of steering gear | Joint |
| Data[5] | direction of steering gear | direction |
| Data[6] | specified speed | sp |
| Data[7] | end frame | 0XFA |
Example:
Given that NO.1 steering gear is revolving clockwise at the speed of 20%:
port return value: FE FE 05 30 01 01 14 FA
range of serial number of joint: 1-6
di: data type of byte, either 0 or 1
sp: data type of byte, ranging from 0 to 100
no return value.
jod-Absolute Control
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X06 |
| Data[3] | command frame | 0X31 |
| Data[4] | serial number of steering gear | Joint |
| Data[5] | highbyte of angle of steering gear | Angle_high |
| Data[6] | lowbyte of angle of steering gear | Angle_low |
| Data[7] | specified speed | sp |
| Data[8] | end frame | 0XFA |
Example:
Given that No.1 steering gear moves to 45° at the speed of 20%
port transmission: FE FE 06 31 01 11 94 14 FA
range of serial number of joint: 1-6
data type of Angle_high: byte
counting method: value of Angle_high is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of Angle_low: byte
counting method: value of Angle_low is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
sp: data type of byte, ranging from 0 to 100
no return value
jog-Coordinate-Oriented Movement
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X05 |
| Data[3] | command frame | 0X32 |
| Data[4] | specified coordinate | axis |
| Data[5] | direction of steering gear | di |
| Data[6] | specified speed | sp |
| Data[7] | end frame | 0XFA |
Example:
Given that robotic arm moves towards x coordinate at the speed of 20
port transmission: FE FE 05 32 01 01 14 FA
axis ranges from 1 to 6, representing x, y, z,rx, ry, rz
di: data type of byte, either 0 or 1
sp: data type of byte, ranging from 0 to 100
no return value
jog-Stepper Model
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X06 |
| Data[3] | command frame | 0X33 |
| Data[4] | serial number of steering gear | Joint |
| Data[5] | highbyte of angle of steering gear | Angle_high |
| Data[6] | lowbyte of angle of steering gear | Angle_low |
| Data[7] | specified speed | sp |
| Data[8] | end frame | 0XFA |
Example:
Given that the angle of No.1 steering expand by 45° and revolves at the speed of 20
port transmission: FE FE 06 33 01 11 94 14 FA
serial number of joint ranges from 1 to 6
data type of angle_high: byte
counting method: value angle is multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of angle_low: byte
counting method: value of angle is multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
sp: data type of byte, ranging from 0 to 100
no return value
jog-Stop
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X34 |
| Data[4] | end frame | 0XFA |
Example:
Stop moving
port transmission: FE FE 02 34 FA
no return value
Sending Potential
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X05 |
| Data[3] | command frame | 0X3A |
| Data[4] | serial number of steering gear | Joint |
| Data[5] | high status of potential | Encoder_high |
| Data[6] | low status of potential | Encoder_low |
| Data[7] | end frame | 0XFA |
Example:
Given that No.5 joint is set to 2048
port transmission: FE FE 05 3A 05 08 00 FA
serial number of joint ranges from 0 to 5
data type of Joint: byte
data type of Encoder_high: byte
counting method: get the high status of potential (in hexadecimal form)
data type of Encoder_low: byte
counting method: get the low status of potential (in hexadecimal form)
no return value
Get the Potential
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X3B |
| Data[4] | serial number of joint | joint |
| Data[5] | end frame | 0XFA |
Example:FE FE 03 3B 02 FA
get the potential of NO.2 steering gear
serial number of joint ranges from 1 to 6
Return Value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X04 |
| Data[3] | return value: command frame | 0X3B |
| Data[4] | high status of potential | Encoder_high |
| Data[5] | low status of potential | Encoders_low |
| Data[6] | end frame | 0XFA |
Example:
port transmission: FE FE 04 3B 08 07 FA
How potentials are counted:
potential = low status of potential + high status of potential * 256
Sending Potential of Six Steering Gears
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0E/0X0F |
| Data[3] | command frame | 0X3C |
| Data[4] | highbyte of No.1 steering gear | encoder_1_high |
| Data[5] | lowbyte of No.1 steering gear | encoder_1_low |
| Data[6] | highbyte of No.2 steering gear | encoder_2_high |
| Data[7] | lowbyte of No.2 steering gear | encoder_2_low |
| Data[8] | highbyte of No.3 steering gear | encoder_3_high |
| Data[9] | lowbyte of No.3 steering gear | encoder_3_low |
| Data[10] | highbyte of No.4 steering gear | encoder_4_high |
| Data[11] | lowbyte of No.4 steering gear | encoder_4_low |
| Data[12] | highbyte of No.5 steering gear | encoder_5_high |
| Data[13] | lowbyte of No.5 steering gear | encoder_5_low |
| Data[14] | highbyte of No.6 steering gear | encoder_6_high |
| Data[15] | lowbyte of No.6 steering gear | encoder_6_low |
| Data[16] | specified speed | Sp |
| Data[17] | end frame | 0XFA |
Example:
Given that the potential of all is 2048, and the speed is 20
port transmission: FE FE 0F 3C 08 00 08 00 08 00 08 00 08 00 08 00 14 FA
Refer to the chart above for each potential.
data type of encoder_1_high: byte
counting method: convert the potential of No.1 steering gear into integral form and get the highbyte hexadecimal
data type of encoder_1_low: byte
counting method: convert the potential of No.1 steering gear into integral form and get the lowbyte hexadecimal
sp: data type of byte, ranging from 0 to 100
no return value
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X3D |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 3D FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0E |
| Data[3] | command frame | 0X3D |
| Data[4] | highbyte of No.1 steering gear | encoder_1_high |
| Data[5] | lowbyte of No.1 steering gear | encoder_1_low |
| Data[6] | highbyte of No.2 steering gear | encoder_2_high |
| Data[7] | lowbyte of No.2 steering gear | encoder_2_low |
| Data[8] | highbyte of No.3 steering gear | encoder_3_high |
| Data[9] | lowbyte of No.3 steering gear | encoder_3_low |
| Data[10] | highbyte of No.4 steering gear | encoder_4_high |
| Data[11] | lowbyte of No.4 steering gear | encoder_4_low |
| Data[12] | highbyte of No.5 steering gear | encoder_5_high |
| Data[13] | lowbyte of No.5 steering gear | encoder_5_low |
| Data[14] | highbyte of No.6 steering gear | encoder_6_high |
| Data[15] | lowbyte of No.6 steering gear | encoder_6_low |
| Data[17] | end frame | 0XFA |
Example:
Given that all robotic arms are set in zero position,
port return value: FE FE 0E 3D 08 00 08 00 08 00 08 00 08 00 08 00 FA
How to count potential
How potentials are counted:
potential = low status of potential + high status of potential * 256
Reading Potential of Six Steering Gears
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X3D |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 3D FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0E |
| Data[3] | command frame | 0X3D |
| Data[4] | highbyte of No.1 steering gear | encoder_1_high |
| Data[5] | lowbyte of No.1 steering gear | encoder_1_low |
| Data[6] | highbyte of No.2 steering gear | encoder_2_high |
| Data[7] | lowbyte of No.2 steering gear | encoder_2_low |
| Data[8] | highbyte of No.3 steering gear | encoder_3_high |
| Data[9] | lowbyte of No.3 steering gear | encoder_3_low |
| Data[10] | highbyte of No.4 steering gear | encoder_4_high |
| Data[11] | lowbyte of No.4 steering gear | encoder_4_low |
| Data[12] | highbyte of No.5 steering gear | encoder_5_high |
| Data[13] | lowbyte of No.5 steering gear | encoder_5_low |
| Data[14] | highbyte of No.6 steering gear | encoder_6_high |
| Data[15] | lowbyte of No.6 steering gear | encoder_6_low |
| Data[17] | end frame | 0XFA |
Example:
Given that all robotic arms are set in zero position,
port return value: FE FE 0E 3D 00 00 00 00 00 00 00 00 00 00 00 00 FA
How potentials are counted:
potential = low status of potential + high status of potential * 256
Reading Speed
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X40 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 40 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X40 |
| Data[4] | specified speed | Sp |
| Data[5] | end frame | 0XFA |
Example:
Given that the speed is 50%
port return value: FE FE 03 40 32 FA
Setting Speed
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X41 |
| Data[4] | specified speed | Sp |
| Data[5] | end frame | 0XFA |
Sp: data type of byte, ranging from 0 to 100
Example:
Given that the speed is 50%
port return value: FE FE 03 41 32 FA
Reading the Smallest Angle
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X4A |
| Data[4] | serial number of steering gear | Joint_number |
| Data[5] | end frame | 0XFA |
Example:
Reading the smallest angle of joint 2
Port transmission: FE FE 03 4A 02 FA
serial number of joint ranges from 1 to 6
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X05 |
| Data[3] | return value: command frame | 0X4A |
| Data[4] | serial number of joint | Joint_number |
| Data[5] | high angle of steering gear | Angle_high |
| Data[6] | low angle of steering gear | Angle_low |
| Data[7] | end frame | 0XFA |
Example:
port return value: FE FE 05 4A 02 F9 F2 FA
How smallest angles are counted:
temp = angle1_low+angle1_high*256
Angle1=（temp \ 33000 ?(temp – 65536) : temp）/10
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 10; if temp is less than 33000, then temp is divided by 10 directly.
Reading the Smallest Angle
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X4A |
| Data[4] | serial number of steering gear | Joint_number |
| Data[5] | end frame | 0XFA |
Serial number of joint ranges from 1 to 6
Example:
Reading the largest angle of joint 2
Port transmission: FE FE 03 4B 02 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X05 |
| Data[3] | return value: command frame | 0X4B |
| Data[4] | serial number of joint | Joint_number |
| Data[5] | high angle of steering gear | Angle_high |
| Data[6] | low angle of steering gear | Angle_low |
| Data[7] | end frame | 0XFA |
Example:
port return value: FE FE 05 4B 02 F9 F2 FA
How the largest angles are counted:
temp = angle1_low+angle1_high*256
Angle1=（temp \ 33000 ?(temp – 65536) : temp）/10
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 10; if temp is less than 33000, then temp is divided by 10 directly.
Setting the Smallest Angle
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X05 |
| Data[3] | return value: command frame | 0X4C |
| Data[4] | serial number of joint | Joint_number |
| Data[5] | high angle of steering gear | Angle_high |
| Data[6] | low angle of steering gear | Angle_low |
| Data[7] | end frame | 0XFA |
Example:
Given that the smallest angle of joint 2 is 0
Serial number of joint ranges from 1 to 6
port return value: FE FE 03 4C 32 FA
data type of angle1_high: byte
counting method: angleis multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of angle1_low: byte
counting method: angleis multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
Port transmission: FE FE 05 4C 02 00 00 FA
no return value
Setting the Largest Angle
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X05 |
| Data[3] | command frame | 0X4D |
| Data[4] | serial number of joint | Joint_number |
| Data[5] | highbyte of steering gear | Angle_high |
| Data[6] | lowbyte of steering gear | Angle_low |
| Data[7] | end frame | 0XFA |
Example:
Given that the largest angle of joint 2 is 45
Serial number of joint ranges from 1 to 6
port return value: FE FE 03 4D 32 FA
data type of angle1_high: byte
counting method: angleis multiplied by 100 and converted into integral form to get the hexadecimal highbyte
data type of angle1_low: byte
counting method: angleis multiplied by 100 and converted into integral form to get the hexadecimal lowbyte
Port transmission: FE FE 05 4D 02 11 94 FA
no return value
Checking Connection
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X50 |
| Data[4] | serial number of steering gear | Joint_number |
| Data[5] | end frame | 0XFA |
Serial number of joint ranges from 1 to 6
Example:
Checking whether No.1 steering gear is connected
Port transmission: FE FE 03 50 01 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X04 |
| Data[3] | command frame | 0X50 |
| Data[4] | serial number of joint | Joint_number |
| Data[5] | connected/not connected | 0X01/0X00 |
| Data[6] | end frame | 0XFA |
Example:
No.1 steering gear is connected
Port return value: FE FE 04 50 01 01 FA
Checking Whether All Steering Gears Are Powered On
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X51 |
| Data[5] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 51 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X51 |
| Data[4] | power on/off | 0X01/0X00 |
| Data[5] | end frame | 0XFA |
Example:
Not all steering gears are powered on
Port transmission: FE FE 03 51 01 FA
Reading Servo Parameters
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X04 |
| Data[3] | command frame | 0X53 |
| Data[4] | serial number of joint | Joint_number |
| Data[5] | data address | data_id |
| Data[6] | end frame | 0XFA |
Example:
Reading ratio parameter of P position of No.1 steering gear
Port transmission: FE FE 03 53 01 FA
Serial number of joint ranges from 1 to 6
Data_id: data type byte, referring to the chart below for specific value:
| Address | Function | Range | Initial Value | Explanation |
|---|---|---|---|---|
| 20 | LED siren | 0-254 | 0 | 1\0: turn on/off LED siren |
| 21 | position loop P | 0-254 | 10 | control the ratio coefficient |
| 22 | position loop I | 0-254 | 0 | control the differential coefficient |
| 23 | position loop D | 0-254 | 1 | control the integral-action coefficient |
| 24 | minimum starting force | 0-1000 | 0 | set the smallest torque output capability 1000 = 100% |
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X53 |
| Data[4] | return value: data | data |
| Data[5] | end frame | 0XFA |
Setting Servo Parameters
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X05 |
| Data[3] | command frame | 0X52 |
| Data[4] | serial number of joint | Joint_no |
| Data[5] | data address | data_id |
| Data[6] | parameter | view the table below |
| Data[7] | end frame | 0XFA |
Example:
Reading ratio parameter of P position of No.1 steering gear
Port transmission: FE FE 04 52 01 15 01 FA
Serial number of joint ranges from 1 to 6
no return value
Data_id: data type byte, referring to the chart below for specific value:
| Address | Function | Range | Initial Value | Explanation |
|---|---|---|---|---|
| 20 | LED siren | 0-254 | 0 | 1\0: turn on/off LED siren |
| 21 | position loop P | 0-254 | 10 | control the ratio coefficient |
| 22 | position loop I | 0-254 | 0 | control the differential coefficient |
| 23 | position loop D | 0-254 | 1 | control the integral-action coefficient |
| 24 | minimum starting force | 0-1000 | 0 | set the smallest torque output capability 1000 = 100% |
Setting Zero Position of Steering Gear
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X54 |
| Data[4] | serial number of joint | Joint_no |
| Data[6] | end frame | 0XFA |
Example:
Reading zero position of No.1 steering gear
Port transmission: FE FE 03 54 01 FA
Serial number of joint ranges from 1 to 6
no return value
Braking Single Motor
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X55 |
| Data[4] | serial number of joint | Joint_no |
| Data[5] | end frame | 0XFA |
Example:
Serial number of joint ranges from 1 to 6
Braking No.1 steering gear,
Port transmission: FE FE 03 55 01 FA
no return value
Power Failure of Single Motor
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X56 |
| Data[4] | serial number of steering gear | Servo_no |
| Data[5] | end frame | 0XFA |
Example:
Let No.3 steering gear reducing power
Serial number of servo ranges from 1 to 6
no return value
Powering On a Single Motor
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X57 |
| Data[4] | serial number of steering gear | Servo_no |
| Data[5] | end frame | 0XFA |
Example:
power on No.1 steering gear
Port transmission: FE FE 03 57 01 FA
Serial number of servo ranges from 1 to 6
no return value
Setting Mode of Atom
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X04 |
| Data[3] | command frame | 0X60 |
| Data[4] | serial number of pin | pin_no |
| Data[5] | input/output | 00X00/00X01 |
| Data[6] | end frame | 0XFA |
Example:
setting atom pin22 as input mode
Port transmission: FE FE 04 60 16 00 FA
Pin_no: data type byte
Pin_mode：0/1
no return value
Setting Atom IO (setDigitalOutput)
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X04 |
| Data[3] | command frame | 0X61 |
| Data[4] | serial number of pin | pin_no |
| Data[5] | signal of electrical level | 00X00/00X01 |
| Data[6] | end frame | 0XFA |
Example:
setting atom pin23 as high electrical level
Port transmission: FE FE 04 61 17 01 FA
no return value
Reading Atom IO(getDigitalInput)
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X62 |
| Data[4] | serial number of pin | pin_no |
| Data[5] | end frame | 0XFA |
Example:
reading signal of electrical level of pin23
Port transmission: FE FE 03 62 16 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X04 |
| Data[3] | return value: command frame | 0X62 |
| Data[4] | pin number | pin_no |
| Data[5] | signal of electrical level | 0X00/0X01 |
| Data[6] | end frame | 0XFA |
Example:
Given that pin 22 is of high electrical level
Port return value: FE FE 04 62 16 01 FA
Reading the Angle of Gripper
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X65 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 65 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X65 |
| Data[4] | span of gripper's opening | value |
| Data[5] | end frame | 0XFA |
value：0-100%
Example:
Given that gripper is completely opening
Port return value: FE FE 03 65 64 FA
value: 6 * 16 + 4 = 100
Setting the Mode of Gripper
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X04 |
| Data[3] | command frame | 0X66 |
| Data[4] | gripper opening/closing | 0X00/0X01 |
| Data[5] | speed | Sp |
| Data[6] | end frame | 0XFA |
Example:
making gripper open at the speed of 50
Port transmission: FE FE 04 66 00 32 FA
no return value
Setting Angles of Gripper
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X04 |
| Data[3] | command frame | 0X67 |
| Data[4] | span of gripper's opening/closing | value |
| Data[5] | speed | Sp |
| Data[6] | end frame | 0XFA |
Example:
Given that gripper opens by 50% at the speed of 20
Port transmission: FE FE 04 67 32 14 FA
The value can be converted into hexadecimal
no return value
Setting the Gripper to Zero Position
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X68 |
| Data[4] | end frame | 0XFA |
Example:
Setting the Gripper to Zero Position
Port transmission: FE FE 02 68 FA
Checking Whether the Gripper is Moving
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X69 |
| Data[4] | end frame | 0XFA |
Port transmission: FE FE 02 69 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X69 |
| Data[4] | stop/move | 00/01 |
| Data[6] | end frame | 0XFA |
Given that gripper stops working
Port transmission: FE FE 03 69 00 FA
Setting RGB of Atom
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X05 |
| Data[3] | command frame | 0X6A |
| Data[4] | R | 0X00/0XFF |
| Data[5] | G | 0X00/0XFF |
| Data[6] | B | 0X00/0XFF |
| Data[7] | end frame | 0XFA |
Example:
Setting RGB color as blue
Port transmission: FE FE 05 6A 00 00 FF FA
no return value
Setting IO Output
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X04 |
| Data[3] | command frame | 0XA0 |
| Data[4] | pin number | Pin_no |
| Data[5] | signal of electrical level | 0X00/0X01 |
| Data[4] | end frame | 0XFA |
Example:
Setting high electrical level of pin 2
Port transmission: FE FE 04 A0 02 01 FA
Reading IO Output
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0Xa1 |
| Data[4] | pin number | Pin_no |
| Data[4] | end frame | 0XFA |
Port transmission: FE FE 04 a1 02 01 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X04 |
| Data[3] | return value: command frame | 0Xa1 |
| Data[4] | pin number | Pin_no |
| Data[5] | signal of electrical level | 0X00/0X01 |
| Data[6] | end frame | 0XFA |
Example:
Given that pin 2 has high electrical level
Port return value: FE FE 04 a1 02 01 FA
Acquirng WiFi Account & Password
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0Xb1 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 b1 FA
port return value: ssid: MyCobotWiFi2.4G password: mycobot123
ssid: WiFi account
password: WiFi password
Setting Port Number
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X04 |
| Data[3] | command frame | 0Xb2 |
| Data[4] | highbyte of port | port_high |
| Data[5] | lowbyte of port | port_low |
| Data[6] | end frame | 0XFA |
Example:
Given that port number is 7000
Port transmission: FE FE 04 b2 1b 58 FA
port_high: highbyte of hexadecimal port number
port_low: lowbyte of hexadecimal port number
No return value
Setting Tool Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0E |
| Data[3] | command frame | 0X81 |
| Data[4] | specify high status of x coordinate | x_high |
| Data[5] | specify low status of x coordinate | x_low |
| Data[6] | specify high status of y coordinate | y_high |
| Data[7] | specify low status of y coordinate | y_low |
| Data[8] | specify high status of z coordinate | z_high |
| Data[9] | specify low status of z coordinate | z_low |
| Data[10] | specify high status of rx coordinate | rx_high |
| Data[11] | specify low status of rx coordinate | rx_low |
| Data[12] | specify high status of ry coordinate | ry_high |
| Data[13] | specify low status of ry coordinate | ry_low |
| Data[14] | specify high status of rz coordinate | rz_high |
| Data[15] | specify low status of rz coordinate | rz_low |
| Data[16] | end frame | 0XFA |
Example:
Given that （0，0，50，0，0，0）is tool coordinate,
Port transmission: FE FE 0E 81 00 00 00 00 13 88 00 00 00 00 00 00 FA
no return value
Acquiring Tool Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X82 |
| Data[4] | end frame | 0XFA |
Example:
Port transmission: FE FE 02 82 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0E |
| Data[3] | command frame | 0X82 |
| Data[4] | specify high status of x coordinate | x_high |
| Data[5] | specify low status of x coordinate | x_low |
| Data[6] | specify high status of y coordinate | y_high |
| Data[7] | specify low status of y coordinate | y_low |
| Data[8] | specify high status of z coordinate | z_high |
| Data[9] | specify low status of z coordinate | z_low |
| Data[10] | specify high status of rx coordinate | rx_high |
| Data[11] | specify low status of rx coordinate | rx_low |
| Data[12] | specify high status of ry coordinate | ry_high |
| Data[13] | specify low status of ry coordinate | ry_low |
| Data[14] | specify high status of rz coordinate | rz_high |
| Data[15] | specify low status of rz coordinate | rz_low |
| Data[16] | end frame | 0XFA |
Port return value: FE FE 0E 82 00 00 00 00 13 88 00 00 00 00 00 00 FA
How to get x coordinate:
temp = x_low + x_high*256
x coordinate =（temp\33000 ?(temp – 65536) : temp)/10
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 10; if temp is less than 33000, then temp is divided by 10 directly.
y coordinate is counted in a similar way.
How to get rx coordinate:
temp = rx_low + rx_high*256
x coordinate =（temp \ 33000 ?(temp – 65536) : temp）/100
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 100; if temp is less than 33000, then temp is divided by 100 directly.
ry coordinate is counted in a similar way.
Setting World Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X0E |
| Data[3] | command frame | 0X81 |
| Data[4] | specify high status of x coordinate | x_high |
| Data[5] | specify low status of x coordinate | x_low |
| Data[6] | specify high status of y coordinate | y_high |
| Data[7] | specify low status of y coordinate | y_low |
| Data[8] | specify high status of z coordinate | z_high |
| Data[9] | specify low status of z coordinate | z_low |
| Data[10] | specify high status of rx coordinate | rx_high |
| Data[11] | specify low status of rx coordinate | rx_low |
| Data[12] | specify high status of ry coordinate | ry_high |
| Data[13] | specify low status of ry coordinate | ry_low |
| Data[14] | specify high status of rz coordinate | rz_high |
| Data[15] | specify low status of rz coordinate | rz_low |
| Data[16] | end frame | 0XFA |
Port return value: FE FE 0E 84 00 00 00 00 13 88 00 00 00 00 00 00 FA
How to get x coordinate:
temp = x_low + x_high*256
x coordinate =（temp\33000 ?(temp – 65536) : temp)/10
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 10; if temp is less than 33000, then temp is divided by 10 directly.
y coordinate is counted in a similar way.
How to get rx coordinate:
temp = rx_low + rx_high*256
x coordinate =（temp \ 33000 ?(temp – 65536) : temp）/100
Explanation: if temp is greater than 33000, temp minus 65536, and then is divided by 100; if temp is less than 33000, then temp is divided by 100 directly.
ry coordinate is counted in a similar way.
Setting Base Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X85 |
| Data[4] | base coordinate/world coordiante | 00/01 |
| Data[5] | end frame | 0XFA |
Example:
Given that the coordinate should be set as world coordinate
port transmission: FE FE 03 85 01 FA
no return value
Acquiring Base Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X86 |
| Data[4] | end frame | 0XFA |
Example:
port transmission: FE FE 02 86 FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | return value: identification frame | 0XFE |
| Data[1] | return value: identification frame | 0XFE |
| Data[2] | return value: data-length frame | 0X03 |
| Data[3] | return value: command frame | 0X86 |
| Data[4] | base coordinate/world coordiante | 00/01 |
| Data[5] | end frame | 0XFA |
Example:
port transmission: FE FE 03 86 01 FA
Setting End Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X89 |
| Data[4] | flange | 00/01 |
| Data[5] | end frame | 0XFA |
Example:
Given that end coordinate are set as tool
port transmission: FE FE 03 89 01 FA
no return value
Acquiring End Coordinate
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X02 |
| Data[3] | command frame | 0X8a |
| Data[4] | end frame | 0XFA |
Example:
port transmission: FE FE 02 8a FA
Return value: data structure
| Domain | Explanation | Data |
|---|---|---|
| Data[0] | identification frame | 0XFE |
| Data[1] | identification frame | 0XFE |
| Data[2] | data-length frame | 0X03 |
| Data[3] | command frame | 0X8a |
| Data[4] | flange | 00/01 |
| Data[5] | end frame | 0XFA |
Example:
port return value: FE FE 03 8A 01 FA
Appendix
The specific method of adding coordinate-exchanging programs from Atom repository and sports repository are listed as following.
Change end coordinate.
Set end coordinate by setEndType and getEndType.
FLANGE: Setting EndType as FLANG; TOOL: Setting EndType as TOOL End.
Read tool coordinate via setToolReference and getToolReference. (FLANGE serves as relative coordinate and information about tool end is relevant to FLANGE coordinate.)
After setting EndType as FLANGE, GetCoords and WriteCoords are counted depending on FLANG's position.
After setting EndType as TOOL, GetCoords and WriteCoords are counted depending on end's position.
Change base coordinate.
Set base coordinate by setReferenceFrame.
RFType: Base means setting robotic pedestal as base coordinate; RFType:WORLD means make world coordinate as base coordinate; getReferenceFrame serves to read the type of base coordinate.
setWorldReference and getWorldReference works to read information about base coordinate. World coordinate serves as relative coordinate to type pedestal information of robots that is relevant to world coordinate.
If base coordinate acts as pedestal, GetCoords and WriteCoords take base coordinate as reference coordinate.
If world coordinate acts as pedestal, GetCoords and WriteCoords take world coordinate as reference coordinate.
Information Updating About Communication
These are newly-added functions: setting and reading of end coordinate, world coordinate, present coordinate, type of end, as well as moving method, and sending and receiving of information on robotic arms.
The communication is temporarily set as from 0x80 to 0x8A.
The roboticMessages space is specially added in ParameterList.h for more communication information. Now only No Analytical Solution signal has been added, while more will be added later.
The outline of MOVEL are listed as follows:
First, count the Euclidean Distance between starting point and target point. Second, interpolation points are inserted every 10mm, based on the Euclidean Distance. If interpolation points do not have analytical solution, then search for plus or minus PI/30 from three unchangeable direction for analytical solution. Avoid singular value and some distinctive position that cannot get analytical solution.
Change the interval between MOVEL and JOG into dynamic time. And then, count the time spend moving through the maximum joint. And then, minus the moving time by specific period to take it as interval.