A8 Robot Controller Manual (V1.1)
A8 Robot Controller Manual (V1.1)
A8 Robot Controller Manual (V1.1)
Robot Controller
-A8-
V1.1
Pay attention:
Before using the controller (Including
install,work,transportation,maintain,detection), please read this manual carefully, after
knowing all knowledge about safety.
1
• Before operating, press the Emergency button on the upper right corner.
• Before using teach function in the motion range of robot,please follow the
steps:
- Keeping in the front to watch the robot.
- Follow the steps.
- Please be careful in case of robot move to you.
- Please make sure the safe place in case of accident.
• Must make sure there is no person in the motion range of robot,the
operator should be in safe place:
- When powering up the robot
- Using teach function
- Try to run
Please press emergency if somebody get in the motion range of robot or some
accident happens.
2
Must be sure when operating
The operator knows how to operate.
Knows how it works.
Knows how dangerous it is.
★Need detect before using teach function.
The motion of robot is no abnormalities.
The original point is right or not.
The external accessory equipment is no abnormalities.
★The controller need to take care and put it to the fixed place after using
If the controller is falling down, it will cause robot motion to damage equipment or
get somebody injury.
Safety operation
1 All operators need to know all function of robot and the safety operation.
2 Make sure there is no dangerous before running.
3 Must press emergency and power off when in the motion area.
4 Should watch and be careful when programming in case of press emergency in
time.
5 No gloves when using teach function or move in manual,make sure it is in low
speed.
6 Must know the function and how to stop the external accessory equipment.
7 Never trust the robot is stop, it maybe wait the signal to work the next program.
3
Chapter 2 Summary
SZGH-A8 robot controller use the international embedded bus type,the controlling
circuit use the newest industrial high speed ARM CPU , Mass programming FPGA
technology, multilayer PCB, the whole machine adopts high integration chip and
surface mount element, the structure is more compact and reasonable, and better
ensure the reliability and stability of the system.The software is module designed, to
suit the different structure, industrial application requirements.The robot controller
can realize vertical multi joint robot,vertical articulated parallelogram robot, vertical
multi joint robot, L wrist shaped vertical multi joint robot, spherical wrist robot, Delta
robot ,pole coordinate robot and so many kinds. It is widely used and could be worked
in handling, welding, spraying, palletizing, cutting, polishing,welding and so on.
The controller adopts bus structure with absolute motors, simple structure, practical
and reliable.Use 800X600 TFT LCD technology, LED got uniform brightness and
long service life.
2.1 Functional Characteristics
1) Structure optimization algorithm, adapt to the various kinds of robot;
2) Modular functions, to adapt to a variety of applications;
3) 8 axis control, could realize the auxiliary axis(walking axis, position control);
4) Adapt multi loop absolute motor;
5) Embedded bus type, easy and expand function;
6) 48x32 input and output points,edit PLC online;
7) all kinds of robot process function, simplify the programming and operation;
8) TCP function, tracking function of weld seam;
9) Security module structure, strong practicability, high reliability.
2.2 Technical Parameter
4
Instruction Motion,Logic,Calculation,Technique,also could use the code
of CNC controller;
Coordinate Joint Coordinate,User Coordinate,Tool Coordinate,World
system Coordinate
PLC Ladder graph,8000 steps;
Alarm Emergency,Driver alarm,Safety maintenance,Arcing
abnormal,coordinate system abnormal;
Type of robot 1) vertical multi joint serial robot;
2) vertical articulated parallelogram robot;
3) vertical multi joint L shape wrist robot;Pole coordinate
robot;
4) SCARA robot
5) Delta robot;
6) Special robot;
If the operation is wrong with our controller to cause some accident,read the manual and
operate carefully, must follow the steps from manual,otherwise the result is no relations with our
company!!!
5
Chapter 3 Operation
3.1 Summary
Knowing the parameter of controller.edit program, teach function,reappear
function will be easy to use robot.
3.2 Controller
3.3 Function
3.3.1 Emergency
Note: Usage for emergency need match with the circuit, must be safe and reliable,
otherwise it can’t stop.
6
3.3.2 Switch the mode
Usage for choosing the mode of operating the robot, total 3 kind of mode:Teach
function,reappear,remote.
3.3.3 Safety switch
Safety switch is on back of controller, when the switch is pressed in the middle,
the robot could move in Teach mode; If press it hard or loose it, the robot will stop,
the controller will stop giving the signal.
Note:The switch got total 3 gears, the outermost and the innermost could stop the
robot, only middle gear could let robot move.
Note: The person can’t be in the motion range of robot,the robot will move when the press
is in the middle, in case of accident.
3.3.4 Handwheel
Enter Cancel
The program will start forward The program will start backward
in reappear mode; in reappear mode;
Note: The robot will move when press Start. Must be carefully.
8
Total 16 gears in 0%~150%.
(1)Ratio of spindle
9
Press right side of screen,it will shows the touch keyboard.
Press “Page” to enter the program management, could edit, modify,search, delete,
copy and so on.
Press “Page” again to enter parameter management, could modify and check parameter.
The Teach function is used for adjust the coordinate of robot and the motion of
accessory axis to programme.
Adjust position of touch screen:If the position of button is wrong,you can press”6” or
“Pause”in code parameter and press enter, then restart the power.
3.4.1 Button in Teach function
(1)“F” or “V”:Set the feeding speed of Joint;
(2)“Step” or “Hand”:Switch “Continuous”,“ Incremental”,“Handwheel”.
(3)“S” or “A” : Set the speed of the first spindle (The first analog output), the
max value is up to the No.43 parameter in speed parameter.
(4)“I”:Modify the value of I in Step mod.
(5)“T” : Set the number of the current tool and TCP point in world Coordinate as the base
point of tool set.
(6)“V↑” : The ratio of feeding speed will increase 10% if press once, total 16
gears in 0—150%.
(7)“V↓” : The ratio of feeding speed will decrease 10% if press once, total 16 gears in 0—150%.
(8)“S↑”:The ratio of spindle speed will increase 10% if press once, total 16 gears in 5—150%.
(9)“S↓”:The ratio of spindle speed will decrease 10% if press once, total 16 gears in 5—150%.
(10)“R”: The current user coordinate backs to zero point, input “XYZABC78” correspond to
“XYZABCXsYs” go back to zero point,if input “0”, then all axis go back.
(11)“Set coordinate F7”:In user coordinate system(G54.1-G54.48/G54-G59) to set the value
of(G54.1-G54.48/G54-G59), update the value of coordinate system; Use “MDI” or F8 to set the
user coordinate system(G54.1-G54.48/G54-G59).
3-points method to set user coordinate system: P1 as original point O, P2 as the direction of +X,
10
P3 as the direction of +Y.
(12) Feed coordinate:Press “+1,-1,+2,-2,+3,-3,+4,-4,+5,-5,+6,
-6,+7,-7,+8,-8” correspond to J1-J6,Xs,Ys to move + or -.
(13) In the mode of teaching function, first press “Home” + “S↑” output M03, press “Home”
+ “S↓” output M04, it will stops the motion when not press.
(14)“Tool set F6” or “H”, use for making sure the coordinate in tool coordinate system.
Two methods to set tool coordinate of 6 axis robot: 3-points and 5-points.
(A) 3-points:P1P2P3 for changing the motion of robot and keep the TCP point to be the same
position, the motion of 3-points tool coordinate is the same as motion of electrical connection
coordinate system.(The coordinate system of the 6th axis flange of robot wrist).
(B) 5-points : P1P2P3 are the same as 3-points, but the motion of tool coordinate system is
settled by P3P4P5. P3 means the original potion, P4 means the direction of +X, P5 means the
direction of +Z.
Press “Start” in the set process, the statues will show “O”, then press “12345” to adjust the
speed to back to the point set the last time, easy to modify. After once operation, this function will
be closed automatically.
The posture of P3P4P5 in 5-points need to be the same(Value of ABC in world coordinate
should be the same ) [The interface needs to be without N letter]. So it is necessary to convert into
the world coordinate system after setting of P3, then move the robot to set P4 in the direction of X
axis and P5 in the direction of Z axis.
After input P1P2P3 3 points in tool set, the controller will calculate the position and posture
of tool coordinate in world coordinate, if 3 points is too near, then it can’t be exist P1P2P3, the
controller can’t calculate the value, it will delete P2P3 automatically.
XYZ of tool set mean the original point of tool coordinate in world coordinate, ABC mean the 3
axis posture in space(position and direction) of tool coordinate in world coordinate.
Note:P1P2P3 in 3-points need be different posture;But the tool posture of P3P4P5 in 5-points need to be
on the same straight line(It is fine if it isn’t straight line, just the direction of Z axis in tool coordinate is not
on the same straight line with weld gun)
Press to choose the coordinate system, in the teach mode,could choose “Joint
coordinate” “User coordinate” “Tool coordinate” “World coordinate”;
1) Joint coordinate system
The robot move along the each axis line, all used coordinate system named joint coordinate system.
The joint coordinate system is settled down when robot is settled down, can’t change.
The controller can support many kinds of robot, please look up to the definition of robot to make
sure the motion direction of each joint coordinate system, example:
A. Six axis serial joint robot
12
C.4 axis rotary joint palletizing robot
The usage for joint and world coordinate, use the switch for changing the mode,and then
use +/- to move the robot or programme.
User and tool coordinate need 2 conditions, use the suitable coordinate number,change into
suitable coordinate system. After these conditions, you can use Teach function to programme in
this coordinate.
Note: The coordinate you choose will be taken into the teach program when editing in the teach mode, so
need to make sure the coordinate system.
16
3.8 Parameter
Press “Page” to enter. The parameter includes “Processing” “Speed” “Axis”
“Technique” “Other parameter” “Coordinate” “Code”.
Note: The instruction of controller contains parameter of CNC controller, so there is some parameter
about CNC.
★3,The program run need the spindle rotate[1 means Yes, 0 means No]
For interlock between program and spindle, to set if detect rotation of spindle or not while
program running. If set as 1, the spindle needs rotate when program running(Need detect the
encoder rotation when it is M03); Set as 0, then no need to detect.
★5, The counts of workpiece will be counted automatically[1 means Yes, 0 means No]
Reappear counts of program, if it is 1, the count of workpiece will add by one automatically
when running M30, M20, M02.
17
★6,The delay time of feeding axis to go reversal(ms) Set it as 0 when it is highly requirement.
★7,The delay time of segment in G01/G02/G03(ms)(>100 effective) This parameter solves the
overcut problem in the corner.
★9,Continuous motion is worked in G00[16 means Yes, 1 means No] If set as 16, then it will
not reduce, continuous work.
★ 11, The number of pulse of each round of spindle encoder.(4 times the number of encoder)
★12, The alarm value of spindle encoder(Diagnosis value)[>10 effective] Set it as the same as
the diagnosis value.
★13, Detect the feedback position of spindle(1 means Yes, 0 means No)
Set it whether to detect the feedback signal of spindle position, the spindle encoder signal.
1 means to detect, 0 means not to detect.
The parameter applies to functions about speed of spindle such as real rotate speed and
feeding value. Precondition of these function is feedback signal of spindle encoder matching
with spindle by transmission ratio of one to one.
★16,From the end of the last segment program if start from the middle line.[8 means Yes, 0
means No]
Set as 8, it will starts from the end of the last segment program.
★17, Start the program by the input point [D2-D7(+4...+128) correspond to X26-X31, D8-
D15(+256...+32768) correspond to X16-X23]
Set as +4+8=12 , when X26 or X27 is effective to choose the program HIDEFILEX26 or
X26 or HIDEFILEX27 or X27.
18
3.8.2 Speed parameter
★1-6, The speed of J1-J6 MOVJ(degree/s)
The most speed of J1-J6 MOVJ in rapidly speed instruction
★7,8, G00 speed of Xs,Ys axis(mm/min) The max speed G00 of XsYs axis
★13, Feeding speed in teach(mm/min) The range: The max feeding speed in teach
Note: Press F or V to set in teach, it will refresh this value
★27,The speed when handwheel is stop(mm/min)[>18] The bigger value is, the sooner it will be
stop.
19
★28,The acceleration and deceleration constant of handwheel[500--30000] The bigger value, the
sooner will be faster and slower.
★31,The type of acceleration and deceleration[0 means straight line,8 means curve line(S type)]
Note: The set is relative with driver, normally, step type use curve,servo use straight line.
★32,The initial acceleration and deceleration constant in curve type[>=10] The bigger value is,
the sooner it accelerates.
Note: Effective bigger than 10.
★33,Quadratic constant of acceleration and deceleration in curve[>=10] The bigger value is, the
sooner it accelerates
Note: Effective bigger than 10.
★34,The max acceleration and deceleration constant in curve[>=500] The bigger value is, the
sooner it accelerates
Note:It is effective when bigger than 500, otherwise only use straight line.
★52,The start reduce speed in hard limit(mm/min) Servo needn’t reduce, set as 1 normally.
20
★53,Active speed pre-treatment function[1 means Yes, 0 means No] Set as 1 to active, set as 0
not to active.
★ 54-58,Start the smooth function(+4 means teach;+8 means handwheel;+16 means program in
PLAY)
The range is 50-100, smaller value corresponds the faster reduce, but bigger vibration. The
time constant is set by No.55-No.58.
★100-105,The max speed of J1-J6 in teach when not in joint coordinate system(deg/min)[>1]
Not in joint coordinate means world coordinate or user coordinate.
21
3.8.3 Axis parameter
★1,Soft limit [D2 means X axis;D3 means Y axis;D4 means Z axis;D5 means A axis;D6 means B axis;D9
means C axis;D10 means Xs axis;D11 means Ys axis;1 means not limit;D12 means MOVE;D14 means no
limit in changing tool]
Set each axis in each bit. 1 means valid soft limit in corresponding bit, 0 means invalid.
Format: D15D14……D1D0.
Example: If set soft limit of X axis, then set as:00000100
★ 2-17, The max movement in positive and negative direction of XYZABCXsYs axis(mm)
This value is based on the world coordinate system.
★18-29,The max movement in positive and negative direction of J1-J6(deg) The value is based on the joint
coordinate system.
★43,The reversal direction signal of J6 Xs Ys(+2 means J6,+4 means Xs axis,+8 means Ys axis)
Set as 0 means reversal direction, set as 1 means the same as direction is specified.
★44,Close the electrical gear of feeding axis[1 means Yes, 0 means No]
★61,The requirement for feeding axis back to zero point [1 means no need, 0 means prompt, 8 means force,
9 means super force]
Set as 0 means no need, system will not prompt and limit when power on.
Set as 1 means prompt, system will prompt but no limit when power on.
Set as 8 means force, system will prompt when power on, and if no operation of back reference point, it
will refuse to execute program.
Set as 9 means super force, motion system of feeding axis will prompt when power on, and if no
operation of back reference point, it will refuse to execute motion.
★61-1,The type of feeding axis back to zero point[0 means detect zero point reversal; 1 means not detect
zero point reversal; 2 means ]
Few methods for setting detection switch and zero pulse signal of motor encoder when each axis is
backing to zero point:
Set as 0: When backing to zero point, crush to the reference switch, running reversal after the switch is
off, then detect the zero pulse signal of motor encoder.
Set as 1: When backing to zero point, crush to the reference switch, running reversal after switch is off.
Set as 2: When backing to zero point, crush to the reference switch, continue to run after the switch is off,
then detect the zero pulse signal of motor encoder.
Set as others:When backing to zero point, crush to the reference switch, continue to run after the switch
is off.
22
According to the circuit to set, normally suggest to set as 0 or 2, if not to detect the zero pulse signal of
motor encoder, the accuracy will be worse, it only base on switch of reference point.
★61-2,Bit parameter of the direction of backing to zero point[D2 means X; D3 means C(Y); D4 means Z;
D5 means A; D6 means B; D7 means B; D8 means C; D9 means Xs; D10 means Ys] 1 means negative, 0
means positive Exclusive setting of direction and sequence for every axis.
Example: If X axis need back to zero point negative, set as: 000000100
★61-3, Normal close bit parameter of the switch of backing to zero point D0 means X, D1 means Y, D2
means Z, D3 means A, D4 means B, 1 means normal close, 0 means normal open.
Example: If X, Y, Z axis are all always close switch, set as:000000111
★62,Floating zero point [D3 means X axis; D4 means Y axis; D5 means Z axis; D6 means A axis; D7
means B axis; D8 means C axis; D9 means Xs axis; D10 means Ys axis; 1 means floating zero point, 0
means mechanical zero switch]
★63-70,Set the floating zero point in world coordinate system of XYZABCXsYs axis
Set this parameter as the current coordinate of XYZABCXsYs axis, each axis goes back to zero point
to here. If no mechanical zero point, set it as floating zero point. System will locate the zero point rapidly in
operation of back to zero point.
★214, Follow the axis(7/8/9,17/18/19,27/28/29/D5..D13=1/ means A axis follow X/Y/Z, C axis follow
X/Y/Z, B axis follow X/Y/Z)
★220, Full pulse controlling channel of the first spindle(Positive 81-86 correspond to XYZABC axis ,
Negative 91-96 correspond to XYZABC axis)
★222, Increasing and decreasing speed of the first spindle which is full pulse control
★ 223, Full pulse controlling channel of the second spindle(Positive 81-86 correspond to XYZABC axis ,
Negative 91-96 correspond to XYZABC axis)
★225, Increasing and decreasing speed of the second spindle which is full pulse control
★290, Controlling mode(4000-4099 means etherCAT, 6000 means Modbus, 6001 means 1-6 axis use
Modbus, 6002 means 3 axis use Modbus)
★300,The number of bus bits of bus motor encoder. If the encoder is 17bits bus absolute encoder, set as 17.
★ 511,No.8 parameter of drive which is J1,the proportion plus of current loop.The bigger, the bigger
current.
★512,No.9 parameter of drive which is J1, the proportion plus of speed loop.The smaller, the sound
23
smaller
★513, No.10 parameter of drive which is J1, the plus of position feed forward. The bigger, the bigger
vibration
★514,No.11 parameter of drive which is J1, the proportion plus of position loop.The bigger, the stronger
rigidity
★517,No.44 parameter of drive which is J1, the plus of position following. The smaller, the stronger
following
★518,No.30 parameter of drive which is J1 ,M133 mode(0 means constant speed,1 means reciprocate,2
means fixed distance)
★518-1,No.40 parameter of drive which is J1,The swing distance of M133 (low 16 bits)
24
3.8.4 Technique parameter
★1-0,The basic technique parameter in welding[0-9] Arc weld instruction AS* to be invoked
parameter group.
★1-1,Basic technique group: Open the function of “Back” or not[8 means open, other means
closed]
Set as 8 means, press “Back” got the back function when it is pause.
★1-6,Basic technique group: Open the scrape function or not[8 means open, others mean closed]
Scrap function open means, after execution of AS*, keep running for a distance to ensure arc strike
when output of arc starting is effective. If arc strike succeeds in scrape range, then back to start
point and execute welding; if arc strike fails then alarm and quit. Scrap function close means, after
execution of AS*, when output of arc starting is effective, wait for a period to check if arc strike
succeeds or not, if succeed then weld, if fail then alarm and quit.
★1-9,Basic technique group: Starting of arc and arc extinction:+2 means the starting of arc is
specified; +4 means arc extinction is specified.
Starting of arc means the progress of instruction AS*,arc extinction means the progress of
instruction AE*.
When setting as user-defined, the basic technique No.1-10 and No.1-25 are useless, the
progress of Starting of arc is controlled by ProgramUser0, the progress of arc extinction is
controlled by ProgramUser1, edited by user.
If it isn’t user-defined, the progress of starting of arc: Process of arc starting defined in
software:
1>, Output of huff is valid
2>, The output voltage of starting of arc is specified by basic technique group No.1-10
The output current of starting of arc is specified by basic technique group No.1-11
25
3>,Waiting time of air clean is specified by basic technique group No.1-16(ms) 4>,Waiting time of
feeding air is specified by basic technique group No.1-17(ms) 5>,Output of starting of arc is valid
6>,Waiting time of electrical arc detection is specified by basic technique group No.1-No.18(ms)
7>,If not open the scrape function, it will check the strike arc is success or not, it will quit if not
success. If open the scrape function, it will ignore this step.
8>,Restore the output voltage and current of user programme. 9>,Output of feeding solder wire is
valid[M03/Y18]. Execute progress of welding automatically.
The progress of arc extinction:
1>,Close output of feeding solder wire[M05]
2> , The voltage of output weld treatment is specified by basic technique group
No.1-12
The current of output weld treatment is specified by basic technique group No.1-13
3> , Waiting time of weld treatment is specified by basic technique group
No.1-21(ms)
4>, The voltage of after treatment is specified by basic technique group No.1-14 5>,(A)Set the
mode of welding control to be MIG-VW and TIG-AW:
The backing speed of after treatment for solder wireis specified by basic technique group
No.1-15; The output of backing solder wire is effective, the feeding output of feeding solder wire
is invalid; Waiting time of after treatment is specified by basic technique group No.1-22(ms);
Stop backing solder wire, output of backing and feeding are both invalid, the
speed is 0.
(B)Set the mode of welding control as MIG-VA and TIG-A: The output analog current of weld
will be 0; Waiting time of after treatment is specified by basic technique group No.1-22.
6>,Stop arc, output of starting arc is invalid.
7>,If output of huff is valid, then execute operation as below:
Waiting time of after huff is specified by basic technique group No.1-20.
Close output of hull.
8>,If the detection of cladding is bigger than 0, then operation as below: Set the output analog
voltage as 0; Delay the waiting time of cladding detection is specified by basic technique group
No.1-23; Output of cladding detection is valid[M73/Y21];
Delay the waiting time of cladding detection is specified by basic technique group No.1-24 ,set
should over parameter 105;
(A) Check remove cladding is successful or not[X03], the operation as below if successful:
Waiting time of cladding detection is specified by basic technique group No.1-25(ms);
Close output of cladding detection
(B) If remove cladding is failed, then operation as below Close output of cladding detection
If the frequency of cladding detection is over the value of parameter, it will alarm and quit,
otherwise output of starting arc is valid. Back to execute 4>step;
9>, Restore the output voltage and current of user program.
Then execute the next steps of program.
26
★1-18,Basic technique group: The detection time of electrical arc(ms)
★1-19,Basic technique group: Starting time(ms)
★1-20,Basic technique group: Time of behind delivery gas(ms)
★1-21,Basic technique group: Time of welding port treatment(ms)
★1-22,Basic technique group: Time of behind treatment(ms)
★1-23,Basic technique group: Delay time of cladding detection instruction(ms)
★1-24,Basic technique group: Delay time of cladding detection (ms)
★1-25,Basic technique group: Time of cladding detection(ms)
★1-26,Basic technique group: Reserve
Auxiliary relay of controlling arc starting: Valid M56 means starting of arc, otherwise it means
arc extinction.
Programmable instruction: M71 refers to starting of arc, M70 refers to arc extinction. Output
point of arc starting: Y09
Auxiliary relay of controlling huff: Valid M50 means huff starting; otherwise it means huff
closing.
Programmable instruction: M59 refers to huff starting, M58 refers to huff closing.
Output point of huff: Y20.
Auxiliary relay of output of cladding detection: valid M57 means open, otherwise it means
close.
Programmable instruction: M73 refers to open, M72 refers to close. Output point of cladding
detection: Y21.
Auxiliary relay of input of cladding detection: valid M72 means successful cladding, otherwise
it means failed cladding.
Definition of cladding: to consolidate workpieces through melted metal wire Input of arc
starting detection: X00
Malfunction detection of welding machine: X01 Input of cladding detection: X03
Detection of cooling anomaly: X04 Detection of lubrication alarm: X05 Detection of arc
depletion alarm: X06 Detection of gas depletion alarm: X07 Detection of metal wire depletion:
X46 Detection of power anomaly: X47
Auxiliary relay of manual feeding solder wire: M53 Auxiliary relay of manual back solder wire:
M54 Auxiliary relay of stopping feeding/back: M55
Programmable instruction: M3—Feed solder wire; M4—Back solder wire;
M5—Stop feeding or backing.
Output point: Y18—Feed solder wire; Y19—Back solder wire; Y12—Stop feeding or backing.
If the seam is wider, weaving weld is applied. Just program the instruction WS* of starting
weld in the next line of instruction AS*. The parameter of weaving weld contains 10 groups from
0 to 9, specifying by WS*, to close weaving weld by WE before the line of AE*.
27
★2-2,Distance of weaving(um)
Distance between every two weaving segments.
★2-3,Extent of weaving(um)
Distance between two weaving points from A to B.
★ 2-5,The pause time at B point(ms)(ms) Weave weld to B point and the pause time(ms).
Search Function:
In this mode, the workpiece is grounded while nozzle or solder wire is electrified with low
voltage. During the motion of robot along searching track, if nozzle or wire contacts with
workpiece, dip of electric level will generate signal of contacting, then robot stops moving and
records contacting position, and rectifies path through offset value between current and specified
position to calculate position of real target. Search starting instruction: ST* P*
The number after ST specifies group number of searching [0—9] The number after P
specifies number of value data from searching result[0—99], the data corresponding to number
will be deleted automatically while executing the instruction P.
Search stopping instruction: SE Searching instruction in straight running: SX search in the
direction of X axis; SY search in the direction of Y axis; SZ search in the direction of Z axis;
The number behind SX/SY/SZ means the repeat times, controller will calculate
28
the average, the most times is 9, only once if no number. For example, SX5; SY6; SZ4; SY; SX.
Example:
G54 T1; Specify the user coordinate system and tool number MOVJ ;Locate to the starting
point of search
ST2 P3; Start searching, invoke parameter group 2, it will be saved into data number 3 of
transition data
MOVL; Locate to the starting point of search
MOVL SX ; Search in the direction of X axis, the MOVL point of this line is resultant point
of calibrated workpiece, system will orient according to this point and starting point.
MOVL; Locate to another starting point of search
MOVL SX ; Search in the direction of X axis, the MOVL point of this line is resultant point
of calibrated workpiece, system will orient according to this point and starting point.
MOVL; Locate to another starting point of search
MOVL SY3 ; Search in the direction of Y axis(Repeat 3 times), the MOVL point of this line
is resultant point of calibrated workpiece, system will orient according to this point and starting
point.
SE ; End searching
MOVJ ; Locate to the middle point
SN3 ; Specify the number 3 of position offset data AS4 ; Start arc welding
MOVL ; Execute straight line weld, according to teach point of calibrated workpiece.
MOVL ; Execute straight line weld, according to teach point of calibrated workpiece.
AE4 ; End arc welding
SF ; Close position offset
★ 3-5,Search technique group: Input point of searching detection (+1000 signifies waiting valid
jump. +2000 signifies waiting invalid jump)
To set Input point of searching detection by parameter 3-5. For instance, X12 is set as 1012,
29
denotes that if X12 is valid, searching is finished.
★4-1. Arc tracking technique group: type(+4 means start compensation left and
right, +8 means start compensation up and down)
★4-6. Arc tracking technique group: the value of compensation left and right, if detect result as
01.(um)
★4-7. Arc tracking technique group: the value of compensation left and right, if detect result as
10.(um)
★4-8. Arc tracking technique group:the value of compensation up and down, if detect result as
01.(um)
★4-9. Arc tracking technique group:the value of compensation up and down, if detect result as
10.(um)
★101. Open interruption of wire feeding or not(M03)[0 means open, 1 means close]
★105.Detecting time of successful arc extinction[X0 invalid](unit:10ms) Over the time means
successful arc extinction.
★503,Save the data of the current position point[Note to the current tool number and user
coordinate system]
Save data of position, invoke number 0—499 of parameter
30
Note: The current tool number and user coordinate system.
★506,Calculate the data of movement value according to the two position point[Note to the
current tool number and user coordinate system]
Modify the data is specified by SN*. According to No.501-No.503 to calculate moving value and
save in parameter group.
34
Arrange every XYZC coordinate which correspond to every stack one by one.
If there is N in coordinate, it means there is no set for this stack.
(3) palletcurr.txt to save the current status of depalletizing (The current stage will be saved
when power off)
Format:
Palltcode:
The data behind is: The number;
The times of stack been executed[Start from 0 to count];
The number of the current layer[Start from 0 to count] (If palletizing then count from bottom
to top, if depalletizing then count from top to bottom);
The current line number [Start from 0 to count] (The meaning of palletizing is the same as
depalletizing);
The current column number [Start from 0 to count] (The meaning of palletizing is the same as
depalletizing);
The number of the stack in the current layer [Start from 0 to count].
51
3.8.5 Other parameter
★1,Filter constant of input signal [+256+512+1024 correspond to X0-X7, the filter is 2/4/8ms,
+2048+4096+8192 correspond to the filter 2/4/8ms of other signal]
Filter for input points, for example: input 256 correspond to X0-X7 filter 2ms, input 2304
correspond to all input point filter 2ms.
★2,The band switch of feeding axis[1 means yes, no means no] Reserve, this controller must set
as 0.
★3,The band switch of spindle[1 means yes, no means no] Reserve, this controller must set as 0.
★4,The type of handwheel[1 means held,0 means panel] Reserve, this controller must set as 0.
★7,The interval time of lubrication(s) The valid interval time between two M32 (s)
★ 10,Bit parameter
D1=1 clear to 0; D2=1 space ;D5=0 close spindle; D6 speed; D8=1 save M10 when power
on;D10=1 arrange; D12=1 skip is invalid; D13=1 back to 0 is invalid
The format:D15D14……D1D0.
D0 bit:Default as 1, can’t change.
D1 bit:Set as 1 means the number of workpiece clear automatically when power on, set as 0
means keep.
D2 bit: Set as 1 means insert space into letters automatically when editing the program, set as
0 means not insert.
D3 bit:Default as 0, can’t change. D4 bit:Default as 0, can’t change.
D5 bit : Set as 1 means not stop spindle rotation and cooling when pressing RESET, 0 means
stop, default is 0.
D6 bit : Set as 1 means each axis work according to own speed, work with nonlinear
trajectory when executing G00, 0 means simultaneous, reach at the same time. Default is 1.
D7 bit:Default as 0, can’t change.
D8 bit:Set as 1 means save the status M10/M11 of spindle loose or tight when power off,
recover this status when power on again. Set as 0 means spindle will be tight automatically when
power on.Default is 1.
D9 bit:Default as 1, can’t change.
D10 bit : Set as 1 means the number of line is arranged automatically when programming.
D11 bit:Set as 1, the output analog of the first spindle is the same time from the first, second
spindle channel, the function of the second spindle is valid.
52
D12 bit : Set as 1, shield the skip function, “/” in front of the segment means invalid.
D13 bit:Default as 0, can’t change.
D14 bit:Default as 0, can’t change.
D15 bit : Set as 1, the tool set show the relative value, otherwise it shows the absolute value.
Note: This parameter includes the bit which can’t be changed. If change this bit, it will cause some problems
with controller.
★ 12,The operation mode of delete[0 means delete the behind,1 means delete the forward]
★ 14,Back function of running program[+8 means the handwheel, +32 means the back button of
panel]
To set handwheel reappear mode as the way of executing program, if D3=1,
+8 means handwheel enabled, positive rotating means run program forward, negative rotating
means run program backward; +32 means panel button enabled, otherwise run forward and
backward identically.
★16,Emergency alarm[0 means always open,1 means always close] Set the input point X209 of
emergency button.
★17,Lubrication alarm[0 means always open,1 means always close] Set the input point X09 of
lubrication alarm.
★21,Long signal of spindle brake[0 means long signal, 1 means short signal]
★22,The interlock between spindle rotation and chuck[1 means Yes,0 means No]
1 will be safer.
Consi
der
for
safety,
set as
53
★ 23,The brake of motor is work or not[1 means check the X40 when motor with brake, 0 means
without brake]
If without brake, then set as 0(X40 could be used for other function);If set as 1,then motor
with brake, controller check the X40 signal, it means the circuit is normal, otherwise there is some
problems, please check the problem and solve.
★ 32,Logical of robot high speed I/O[0 means stop, 18 means start with high speed, 28 means
super speed]
Super speed means 2ms, high speed means 8ms.
Note: This parameter usually be test parameter, set as 1 in actual use, otherwise the motion of robot could
be wrong.
★35,Soft limit is effective in teach when no back to zero[1 means Yes,0 means No]
Note:The set of parameter is relative with safe operation.
★36,Time[Year-Month-Day-Hour-Minute]
For example: 6:06 AM 6th , June ,2016, then input 2016-06-06-06-06
★ 39,40,Special parameter
★41,Backup the current parameter
Note: Press this parameter twice to backup.
★200-204,The error of J1-J6/Xs/Ys axis between feedback pulse and running pulse, alarm when
54
pulse is [>1]
Bigger than 1 is valid. Press “G” to clear the feedback position ,clear position, clear the alarm.
★ 290, Controlling mode(4000-4099 means etherCAT, 6000 means Modbus, 6001 means 1-6 axis
use Modbus, 6002 means 3 axis use Modbus)
★304-308,The number of each circle of absolute encoder of J1-J6/Xs/Ys axis When it is absolute
motor, set it as 131072.
★ 375-385,Coupling function of robot(+4 means J1J2; +8 means J3J4; +16 means J4J5; +32
means J5J6; +64 means J4J6)
D2=1 then +4 means J1J2 coupling , P376,P377 is the numerator and denominator;
D3=1 then +8 means J3J4 coupling , P378,P379 is the numerator and denominator;
D4=1 then +16 means J4J5 coupling , P380,P381 is the numerator and denominator;
D5=1then +32 means J5J6 coupling , P382,P383 is the numerator and denominator;
D6=1 then +64 means J4J6 coupling , P384,P385 is the numerator and denominator;
★460,Calibration robot
The zero point need very high accuracy, otherwise the error is big, need very precise to make the
56
right zero point, this is the regular method, it is the best to use professional equipment to measure.
57
Six axis serial joint robot(No.451=600/602/2600/2602)
Note: a2 needn’t to be set, e2 be set as 0; only if J5 and J6 have offset value, P360 should be set.
★351, Link rod parameter1(um)a2
★352, Link rod parameter2(um)a3
★353, Link rod parameter3(um)a4
★354, Link rod parameter4(um)d2
★355, Link rod parameter5(um)d4
★356, Link rod parameter6(um)e2
★360, Link rod parameter10(um)
★461, The error compensation of No.351(nm)a2
★462,The error compensation of No.352(nm)a3
★463,The error compensation of No.353(nm)a4
★464,The error compensation of No.354(nm)d2
★465,The error compensation of No.355(nm)d4
★466,The error compensation of No.356(nm)e2
(2) Connecting rod of four degree of freedom SCARA and the error compensation
60
Four axis SCARA robot(P451=464)
★351, The connecting rod parameter 1(um)L1
★352, The connecting rod parameter 2(um)L2
★461, The error compensation of No.351(nm)L1
★462, The error compensation of No.352(nm)L2
(3) Connecting rod of four degree of freedom rotation joint palletizing and the error compensation
(4) Four axis connecting rod of palletizing parallelogram robot and the error compensation
62
(5) Four degree of freedom Delta and the error compensation
64
To find a reference point, and move the robot to make the TCP point of tool point at the
reference point, the press the number button 1 to set the point as the P1; then rotate axis XS by a
angle, move the robot, let the TCP point of tool point at the reference point, then press the
number button 2 to set the point as P2; then rotate axis XS by a angle again, move the robot, let
the TCP point of tool point at the reference point, then press the button 2 to set the point as P3.
For single axis positioner, only the three points can finish positioner coordinate system.
For double axis positioner, after the setting of P3, keeping Axis XS, rotate Axis YS by a
angle, then let the TCP point of tool point at reference point and press button 4 to set it as P4;
then rotate Axis YS by another angle( keeping Axis XS), and move robot to point the TCP point
at reference point, and press the number button 5 to set it as P5. Finally, the positioner
coordinate system is set.
Press “Start” in the setting process, the status will show “O”, and press “12345”to back to
the last setting point with the current joint speed in manual, so that modify easier. Press “Start”
to open or close this function, after finish once, this function will close automaticall.
After setting, use M601 or M602 to use the function of positioner, rotate XS axis to check
it is the same as the move direction of robot or not, if not the same, then reversal calculate
+6(D1, D2=1). Use M602 to rotate YS axis to check it is the same as the move direction of robot
or not, if not the same, then reversal calculate
+8(D3=1).
Note: If there are 2 positioners, XS and YS should be vertical intersection, YS should be rotation axis, XS
should be trip axis.
70
★502,IP address
It is better to keep first three numbers the same to address in LAN, for example: 192.168.1.103
★503,MAC address
Make sure every piece should be different address, for example:255:255:255:1
Wi-Fi function of USB internet: The network card of USB use EP-N8508GS and BL-LW05-
AR5, others cannot supported currently. The install steps as follows:
1.Install ES browser on Android phone;
2.Open internet of ES browser -->Remote manager-->Set;
3.Set the number of port to be 3721 or 2121 or 2221
4.Set the root directory and select the internal storage of the cellphone
5.Setting up a management account with anonymity
6.Set the code to be GBK mode
7.Open the remote manager (put the IP address shown into the parameter No.561)
If there isn’t Wi-Fi signal, could use Hotspot of cellphone to form LAN:
1. Open internet of ES browser -->Internet manager-->Create internet hotspot
2. Use defined hotspot, set the user name and code
3. Input the name and code to No.562 and No.563 parameter
4. Quit remote manager and enter remote manager (put the IP address shown into the
parameter No.561)
The operation method of entering the FTP server folder on the controller:
1 Press “N” in the program interface(or shift+N).
2 After entering the FTP server folder, press the "N" key (or F6 key) to exit the FTP server
folder according to the same operation above.
The advantage of using FTP to transfer files is that you can see the contents of PC folder on
the system, and you can freely choose the files you want to transfer, which is more convenient to
use. You can use anonymous login FTP server (no need to set parameter P565, P566), you can also
use FTP username and password, FTP username and password using the original wired network
FTP username and password.
When the system is connected to the wireless WIFI and the wired Ethernet at the same time,
when the FTP server is opened, the wireless WIFI is preferred, and the parameters in the system
are as follows:
★561.The IP address of FTP server of the WiFi hot spot [based on the value of the FTP server in
the cell phone, such as 192.168.2.206]
72
3.8.6 Coordinate system
6 user coordinate system and 1 world coordinate system G53. 1 program could set 1 user
coordinate system, also could set multi user coordinate systems, which could be changed by
moving its original point.
Use G54 to G59 could set 54 coordinate system(G54 -G59,G54.1-G54.48), the original point
of 54 user coordinate system could be changed in interface of setting coordinate system.
Overall modification of user coordinate system G54--59 could be finished in dialog box of
coordinate system deviant in parameter:
1) Input Axxx means the axis of all coordinate system deviate overall, for example, input A12.5
means the coordinate system of current modifying items deviates by 12.5 mm.
2) Input E means reset, input Exxx means input absolute deviant.
3) Input EA means reset the overall axis of all coordinate system,input EAxxx means the axis of
all coordinate system input the deviant.
4) In arbitrary coordinate system of X axis, input EALL means reset all deviant of all axis of
coordinates.
★1. X(mm) of user coordinate system G54 [Input incremental, E means absolute] P1-8 means
XYZABCXsYs of user coordinate system G54(mm)
★11. X(mm) of user coordinate system G55 [Input incremental, E means absolute] P11-18 means
XYZABCXsYs of user coordinate system G55(mm)
★21. X(mm) of user coordinate system G56 [Input incremental, E means absolute] P21-28 means
XYZABCXsYs of user coordinate system G56(mm)
★31. X(mm) of user coordinate system G57 [Input incremental, E means absolute] P31-38 means
XYZABCXsYs of user coordinate system G57(mm)
★41. X(mm) of user coordinate system G58 [Input incremental, E means absolute]
P41-48 means XYZABCXsYs of user coordinate system G58(mm)
★51. X(mm) of user coordinate system G59 [Input incremental, E means absolute] P51-58 means
XYZABCXsYs of user coordinate system G59(mm)
★ 61. X(mm) of user coordinate system G54.1 [Input incremental, E means absolute]
P61-151 means XYZABCXsYs of user coordinate system G54.1-G54.10(mm) Operation:
1. Build the user coordinate system
Usually in status of teach:
a. Press “F8” or “F5” to choose the corresponding user coordinate system(G54-G59).
b. Move coordinate to the fixed position(so that to measure the position), measure the point
73
to the position of zero point in user coordinate system
c. Press “F7” , set P1P2P3 points(correspond to F4 F5 F6 keys).
3-points: P1 is original point, P2 is the direction of +X, P3 is the direction of +Y.
Could press “Start” when setting, the status will shows “0”, then press F4F5F6 to back to the point
the last time set, adjust easily. Press “Start” to open and close this function, it will be closed after
operation.
After setting user coordinate system, the coordinate parameter will shows the value, this value
is the offset of zero point in user coordinate and world coordinate.
74
3.8.7 Code
In case of the parameter can’t be modified, the controller adopt the classified authority code.
Including “CNC factory” “Machine factory” “User”. “CNC” arrange inner parameter; “Machine”
arrange the equipment and electrical parameter of robot; “User” arrange the technique, function
and working.
Initial arrangement of authority is, “CNC” authorized, “Machine”and “user” unauthorized. If want
to enable this function, need use initial code to open, and set the new code, the initial code will be
invalid when setting the new code, must remember the code.
★1,The protection of “CNC”
Inner parameter, unable to operate.
★2,The protection of “Machine”
Since the parameter enabled, parameters about configuration of machinery will be under the
shield. It cannot be operated till the parameter is disabled.
The initial code is “666666”.
75
3.9 Parameter of tool compensation
Press “Page” to enter interface of tool set in any interface, including “Radius compensation”
“Length” “Clear all value” “Clear current value” “Set tool” “Posit tool” “Set”, total 7 functions,
correspond to press “F1-F7” to enter corresponding
interface,press “Esc” to back the primary menu interface.
3.9.1 Radius compensation
Press “F1 radius compensation” in interface of tool set. Set the radius of tool, it’s
compensation of CNC controller.
Method: Press “↑” “↓” to make cursor move to the corresponding tool and press “Enter” to popup
a dialog box, import corresponding tool radius(Absolute value), press “Enter” at last.
76
Initialize the tool radius and the method of length compensation:
Press “F3”(Clear all to be 0), or “F4”(The current to be 0)
3.9.3 Tool set(Redeem)
To build and set the tool coordinate system. To ensure the position and posture of tool
coordinate system in flange coordinate system by P1,P2P,P3,P4,P5. Fix an end effector on robot,
move the robot to the same point according to dialog box by different posture as possible, then set
P1, P2, P3. P1P2P3 specify the original point of tool coordinate system. P4 specifies direction of X
axis, P5 specifies direction of Z axis.
Two methods of setting coordinate system of 6 freedom angle robot: 3-points and 5-points.
(A) 3-points:P1P2P3 to change the different posture of robot, the tool posit TPC point should
be kept the same position, the posture in 3-points is the same as the posture of electrical
connection. (The sixth flange coordinate of electrical wrist).
(B)5-points:P1P2P3 is the same as 3-points, but the posture of 5-points need P3P4P5 to make
sure.P3 means the original position of tool coordinate posture, P4 means direction of +X tool
coordinate posture, P5 means direction of +Z tool coordinate posture.
Press “Start” in the set process, the statues will show “O”, then press “12345” to adjust the
speed to back to the point set the last time, easy to modify. After once operation, this function will
be closed automatically.
The posture of P3P4P5 in 5-points need to be the same(Value of ABC in world coordinate
should be the same ) [The interface needs to be without N letter]. So it is necessary to convert into
the world coordinate system after setting of P3, then move the robot to set P4 in the direction of X
axis and P5 in the direction of Z axis.
After input P1P2P3 3 points in tool set, the controller will calculate the position and posture
of tool coordinate in world coordinate, if 3 points is too near, then it can’t be exist P1P2P3, the
controller can’t calculate the value, it will delete P2P3 automatically.
XYZ of tool set mean the original point of tool coordinate in world coordinate, ABC mean
the 3 axis posture in space(position and direction) of tool coordinate in world coordinate.
Note:P1P2P3 in 3-points need be different posture;But the tool posture of P3P4P5 in 5-points need to be
on the same straight line(It is fine if it isn’t straight line, just the direction of Z axis in tool coordinate is not
on the same straight line with weld gun)
77
3.9.4 Table for tool-case
Press “F6” in redeem interface. To set the tool-case type when radius of tool is compensating.
Method:Press “↑”“↓” to chose the number of tool and press “Enter”, input the type of tool-case
will be fine.
Press “F1” to initialize the tool-case type of all tool.
Set the number of tool
Press “F7” in redeem interface, could set as 99 tools at the most.
3.10 Diagnosis
Press “Page” again to enter this interface under tool compensation.
User could check all input, output and alarm. Press “F2 I/O” and “page up””page down” to
check input and output. Press “F4” to check alarm.
1 means effective, 0 means invalid.
78
Alarm information interface
The first line in this interface shows the number of spindle encoder, the number of
79
current and historical alarm information is record total 10, the superfluous part is clear
automatically, only shows 10 alarm information recently.
80
3.11 Operation of program
Press “Page” to choose the program.
Program management is the same as file management, the storage of the system
is 128M(The max could be expand to 32G) bits to contain program and there is no
limit for quantity of program. Programming adopts full screen operation.
81
The screen prompt the editing program name at the top left corner in the editing
status; The left is the content, the right is the information for lathe status, the
operation in the editing status as follows:
(1) The current cursor locate:
Press “↑↓←→” to move the cursor to any position of program content
Press "Pgup" to the last page.
Press "Pgdn" to the next page.
(2) Character modification: Delete the character at the position of the cursor, then
enter the new character.
(3) The character insertion: Enter a new direct character at the cursor position.
When the input is the letter,the letter in front of automatically generating space. If you
want to enter a space, first enter a letter, and then delete this letter.
(4) The character deletion: Press "Del" directly at the cursor position
(5) Insert the line: Press "Enter" directly, insert a line in front of the current line if
the cursor is at the first line, otherwise insert a line after the current line.
(6) Edit the position data of program line
“Home in touch screen”: If not at the head of line, press this button, it will backs to
the head of line, if at the head of line, it will shows the data of the current position.
“End in touch screen”: If not at the end of line, press this button, it will goes to the
end of line, press again, it will shows the data of the current position, and could
modify.
This button will be useless if there isn’t data of current position.
(7)“F7>>”The next page:
The first page of function:
A,“F1”:Compile the current program.
B,“F2”:To the first line or the last line of program.
C “F3” : Teach function, could press “F2/F4/F5” to record the current user
82
coordinate of XYZABCXsYs.
the mode of teach could be devided into two methods by P13 parameter:one is
generate MOVJ/MOVL/MOVC instruction ; Another is generate G0/G1/G6
instruction.
F2 :When in the first line, press this mean this line is the first line of PLAY,
otherwise it will generate MOVJ or G0 instruction.
F3:Teach, be used to open and close the teach function.
F4 : Record the end point, be used to record the end point of straight line
interpolation and arc interpolation, generate MOVL/MOVC instruction or G1/G6.
F5:The centre of arc, record the centre point of arc, after pressing this button, it
will shows MOVC...... or G6 I**J**K** , to prompt user the next end point position
of arc.
Note: (1)If use MOVJ/MOVL/MOVC instruction, press “F2” or “F4” to input VJ=or V= or PL=,
press enter to not input.
( 2 ) The beginning of program must use MOVJ or G0,otherwise if the starting point is not
the same, the trajectory will be different.
Steps:
(1) Press “F3” to open teach function;
(2) Press “F2”;
(3) Move to the starting point, Press “F2”;
(4) Move to the next point according to the trajectory and requirement:
A)Rapid instruction:Press “F2” to input the rapid ratio and position level. It will
generate rapid instruction MOVJ.
B)Straight line instruction:Press “F4” to input feeding speed, position level and
position point, to generate straight line instruction MOVL.
C)Arc instruction:Press “F5” to record the centre of arc, move to the end point
of arc, press “F4” to input feeding speed, position level and position point, it will
generate arc line instruction MOVC.
83
For example:
1) Input 3 to use translation instruction SN*, * means the number of group it will
use in technique parameter 0-99. It can be checked and modify by No.501-
No.506 technique parameter.
SN*,SF instruction can let robot generate translation motion, be used in palletizing and
flitting, could make programme easier.
2) Input “4” to close the translation function SF.
3) Input “5” to execute instruction AS*,execute the corresponding program
ProgramUser0(User could edit this file as they want).“*” means it will invoke 0-9
group of technique parameter, could be checked and modified by No.1-0/No.1-9
technique parameter.
84
4) Input “6” to the end of arc welding instruction AE*, execute the corresponding program
ProgramUser1(User could edit this file as they want).
5) Input “7” to the start of swing welding instruction WS*, “*” means it will invoke 0-9
group of technique parameter, could be checked and modified by No.2-0/No.2-9 technique
parameter.
WS* ,WE instruction mean it will swing when execute MOVL and MOVC according to
the parameter, used when weld bead is very wide.
6) Input “8” to end of swing welding instruction AE*.
F: “F6”:Delete the current line.
G. “F7”:The first, second page to choose.
H. “F8”:Chang between Chinese and letters.
The second page:
A. “F1”:Delete segment of the program.
B. “F2”:Copy the program.
C. “F3”:Arrange the program.
D. “F4”:Search the specified letters.
E. “F5”:Replace the specified letters.
F. “F6”:Replace the specified letters with all content.
G. “F7”:Choose the first or second page.
H. “F8”:Chang between Chinese and letters.
3.11.2 Teach of welding programme
87
Chapter 4Programming
Note: This robot controller could use the instruction of CNC milling controller, please check the
instruction of CNC milling with milling controller manual.
93
Parameter:
489,Set coordinate system of positioner
490 , The world coordinate of XS when setting P3P4P5 coordinate of
positioner (um)
491,The position of positioner in X(um)
492,The position of positioner in Y(um)
493,The position of positioner in Z(um)
494,The posture of positioner in A(degree)
495,The posture of positioner in B(degree)
496,The posture of positioner in C(degree)
497,Calculate reversal with coordinate of positioner(XS+6;YS+8)
By parameter“489,Set coordinate system of positioner”Set 3-points(single axis
positioner) and 5-points(double axis positioner), it will regenerate the No.490-No.496 parameter.
94
To find a reference point, and move the robot to make the TCP point of tool point at the
reference point, the press the number button 1 to set the point as the P1; then rotate axis XS by a
angle, move the robot, let the TCP point of tool point at the reference point, then press the number
button 2 to set the point as P2; then rotate axis XS by a angle again, move the robot, let the TCP
point of tool point at the reference point, then press the button 2 to set the point as P3. For single
axis positioner, only the three points can finish positioner coordinate system.
For double axis positioner, after the setting of P3, keeping Axis XS, rotate Axis YS by a
angle, then let the TCP point of tool point at reference point and press button 4 to set it as P4; then
rotate Axis YS by another angle( keeping Axis XS), and move robot to point the TCP point at
reference point, and press the number button 5 to set it as P5. Finally, the positioner coordinate
system is set.
Could press “Start” when setting, the status will show “O”, then press “12345”, it will back to
the position which is set the last time with the current manual speed, press “Start” to open and
close, it will be closed automatically after once.
After setting, use M601 or M602 to open the function of positioner, rotate XS axis to see the
direction of robot is the same or not, if not the same, then the parameter of calculate reversal
+6(D1, D2=1). Use M602 to open the function, rotate YS to see the direction of robot is the same
or not, if not the same, then the parameter of calculate reversal+8(D3=1).
Note:If got two positioners, the axis line of Xs and Ys should be vertical intersection, Xs is flip axis, Ys is
rotation axis.
22 Whole operation of depalletizing PW**
Before executing PW**, controller will execute PR** once automatically to reset the
current value.
Note: 1.The macro variable of depalletizing #9001--#9099 correspond to total count of each number of
depalletizing, all finished if it is negative number.
2.The macro variable of depalletizing #9101--#9199 correspond to the current layer number of each
number of depalletizing.
23 Reset the current value of depalletizing PR**
Note:
1)If the number is 9999, then controller finished the Reset;
2 ) The current value of depalletizing includes the current line, column, layer, stack, total stack;
24 Whole operation of once depalleziting PA**
95
After finishing PA**, need to execute PR** to reset, then execute PA**.
25 Choose user coordinate system(G54.1-G54.48/G54-G59)
G54 user coordinate system 1
G54.1/G54.48 user coordinate system
G54.1/G54.48 user coordinate system
G55 user coordinate system2
G56 user coordinate system3
G57 user coordinate system4
G58 user coordinate system5
G59 user coordinate system6
26 Choose tool coordinate system(T01-T99)
T01 Number 1 tool coordinate system
T01 Number 2 tool coordinate system
……
T01 Number 99 tool coordinate system
27 Programme mode(G90/G91)
Two kinds of movement: Absolute and incremental. User G90 and G91 to specify,in absolute,
it’s coordinate of end point. In incremental, it’s movement.
Note: Absolute programme of rotation axis is proximity to calculate, incremental programme is program
to calculate.
28 Rapidly locate(G00)
96
Format:G00 X-Y-Z-A-B-C-Xs-Ys-
Note:X,Y,Z,A,B,C,Xs,Ys, could use absolute or incremental to programme.
Point out value of movement and direction.
Each axis goes rapidly to the end point in G00 separately. Also could use linkage mode:
through P10 parameter D6=0 to set.
The speed of G00 is set by speed parameter.
29 Interpolation of straight line(G01)
Format: G01 X-Y-Z-A-B-C-Xs-Ys- F-
Note: X, Y, Z , A, B , C , Xs , Ys, could use incremental or absolute to programme.The speed is specified by F.
Feeding speed of G01 F could be modified by feeding ratio on panel, the range is 0%~150%.
G01 could be edited as G1.
30 Circle arc in 3D space G06
Format: G06 X_ Y_ Z_ I_ J_ K_ F_
Function: If don’t know the center and radius of circle arc in 3D space. But 3 points is
known on arc, then could use G06, could make sure the direction of arc by the starting point,
end point and the third point between them.
Note: G06 is mode code;
I: The coordinate from the middle point to the starting point of circle arc(X)(direction);
J:The coordinate from the middle point to the starting point of circle arc(Y)(direction);
K: The coordinate from the middle point to the starting point of circle arc(X) (direction).
Note: 1)Middle point:Point Between the starting point and the end point on circle arc;
2) If three points on the same line, it will alarm;
3) I=0, K=0 and J=0 when not specify; If not specify three points, it will alarm.
4) I, J, K like the I, J, K in G02/G03 which is from center to the starting point;
5) G06 can’t be used in circle.
97
For example: G54
G0 X10 Y28 Z10
G06 X30 Y98 Z10 I5 J-6 K-5 F100
X130 Y198 Z120 I55 J-86 K-65 G0X0Z0
M02
31 Delay(G04)
Applies to delaying for certain time before other motions during process.
Format: G04 P-; or
G04 X_ ; or
G04 U_ ;
Function: Every axis is stop and mode instruction is still working when carry out this
instruction, after delaying the specified time to carry out the next program segment.
Instruction introduction:
1.The unit of P delay time is ms(Millisecond)/
2.The unit of X and U delay time are S.
3.Example:
G04 X1; delay for 1s.
G04 P1000; delay for 1s.
G04 U1; delay for 1s.
Special application: G04 can be accurate stop instruction, such as processing corner kinds
of workpiece, it appears over cutting sometimes, if use G04 instruction around the corner, it will
eliminate the over cutting.
Example as follows:
Program: … …
N150 G01 X20 Z10 F100;
N160 G04 P150;(eliminate the over cutting) N170 G01 W-10;
……
Note: Also could set P7 processing parameter to eliminate the over cutting.
32 Return Reference(G28/G281-G288/G301-G308)
G28 ; all axis return to reference
G281 ;only X return to reference
G282 ;only Y return to reference
G283 ;only Z return to reference
G284 ;only A return to reference
G285 ;only B return to reference
G286 ;only C return to reference
G287 ;only Xs return to reference
G288 ;only Ys return to reference
G301 ;X axis return to zero
G302 ;Y axis return to zero
G303 ;Z axis return to zero
G304 ;A axis return to zero
98
G305 ;B axis return to zero
G306 ;C axis return to zero
G307 ;Xs axis return to zero
G308 ;Ys axis return to zero
If use incremental servo type motor and the back to zero point is mechanical way, then use
G281/G282/G283/G284/G285/G286 corresponds to J1/J2/J3/J4/J5/J6 (X0/Y0/Z0 /A0 /B0/C0)
back to mechanical zero point..
33 Program circulation instruction (G22--G800)
G22 is program circulation instruction; G800 is an instruction to end circulates. But G22
must be used with G800 for repeated processing. L means circulation times, the range is 1-
99999. The circulation instruction can nest.
Format: G22 L2 ; begin
:
: ; circulating
G800 ; end
34 Go back the starting point of program (G26/G261-G268)
Format : G26 ; ZXY all go back starting point.
G261 ; X go back starting point.
G262 ; Y go back starting point.
G263 ; Z go back starting point.
G264 ; A go back starting point.
G265 ; B go back starting point.
G266 ; C go back starting point.
G267 ; Xs go back starting point.
G268 ; Ys go back starting point.
35 Remember the current point(G25)
Format:G25; To remember the coordinate of X Y Z A B C Xs Ys
36 Return to the memorial point(G61/G611-G618)
Format: G61 ;Return to X Y Z of memorial point
G611 ;Return to X of memorial point
G612 ;Return to Y of memorial point
G613 ;Return to Z of memorial point
G614 ;Return to A of memorial point
G615 ;Return to B of memorial point
G616 ; Return to C of memorial point
G617 ; Return to Xs of memorial point
G618 ; Return to YS of memorial point
Note: G61 goes back with G00 speed to memorial point of G25.
37 Detect skip(G31, G311)
Format: G31 X_ Y_ Z_ A_ B_ C_ Xs_ Ys_F_ P_ ; if no signal, No alarm
G311 X_ Y_ Z_ A_ B_ C_ Xs_ Ys_F_ P_ ; if signal, alarm
Data behind P: Number of line+(X00/X39+1000 or 2000) , 1000 means availability and
skip,2000 mean invalidation then skip.
For example:G31 X50 Z100 F100 P331022; if X22 availability then goes to N33. G311
X50 Z100 F100 P2021; if X21 invalidation then goes to next
line. If X21 is always valid, it will alarm all the time. Note: Number X00-X47 could be checked
on the diagnosis.
38 M Function
Y05:Output of motor with brake, X40 is the input to check brake;
M03:Feeding welding wire or spindle rotate CW, output Y18;
M04:Back welding wire or spindle rotate CCW, output Y19;
99
M05:Stop welding or spindle, output Y12;
M203:The second spindle rotate CW, output Y28;
M204:The second spindle rotate CCW, output Y29;
M205:The second spindle stop, close Y28, Y29;
M11/M10:Loosen/Tighten tool, output Y10;
M08/M09:Cool switch, output Y11;
M32/M33:Lubrication, output Y08;
M59/M58:Huff, output Y20;
M71/M70: welding start or end, output Y09; X00 is inputting of arc welding.
M73/M72:Cladding switch, output Y21, input X02 to check;
M3330/M4330:User-defined output 0, output Y00;
M3331/M4331:User-defined output 1, output Y01;
M3332/M4332:User-defined output 2, output Y02;
M3333/M4333:User-defined output 3, output Y03;
M3334/M4334:User-defined output 4, output Y04;
M3336/M4336:User-defined output 6, output Y06;
M3337/M4337:User-defined output 7, output Y07;
M3343/M4343:User-defined output 13, output Y13;
M3344/M4344:User-defined output 14, output Y14;
M3345/M4345:User-defined output 15, output Y15;
Enable signal of drive EN: Controller is ready for output Y16;
Reset signal of drive INTH: Output Y17 when drive is reset;
M3352/M4352:User-defined output 22, output Y22;
M3353/M4353:User-defined output 23, output Y23;
M3354/M4354:User-defined output 24, output Y24;
M3355/M4355:User-defined output 25, output Y25;
M3356/M4356:User-defined output 26, output Y26;
M3357/M4357:User-defined output 27, output Y27;
M3360/M4360:User-defined output 30, output Y30;
M3361/M4361:User-defined output 31, output Y31;
Note: M3330-M3361, M4330-M4361 can’t be in the same segment
M14/M15:(Pxxxx) Check X30 valid/invalid(Start from Nxxx line if there is P);
M16/M17:(Pxxxx) Check X31 valid/invalid (Start from Nxxx line if there is P);
M22/M23:(Pxxxx) Check X27 valid/invalid (Start from Nxxx line if there is P);
M24/M25:(Pxxxx) Check X26 valid/invalid (Start from Nxxx line if there is P);
M28/M29:(Pxxxx) Check X25 valid/invalid (Start from Nxxx line if there is P);
WAT+/- :User defined input valid or invalid, X0-X47, total 48ways;
M38xx: Set output point Yxx is valid, example: M3809 means output Y09 is valid;
M48xx: Set output point Yxx is invalid, example: M4807 means output Y07 is invalid;
M18xx: Wait input point Xxx is valid and run the next, example: M1809 means wait input
X09 is valid and run the next.
M28xx: Wait input point Xxx is invalid and run the next, example: M2807 means wait
input X07 is valid and run the next.
M18xx Pxx: According to Xxx; Runs when valid; Skip to Pxx when invalid; example:
M1809 P234 means input X09 is valid and run the next, skip to P234 when X09 is invalid.
M28xx Pxx: According to Xxx; Runs when invalid; Skip to Pxx when valid; example: M2807
P456 means input X07 is invalid and run the next, skip to P456 when X07 is valid.
M97:Program Pxxx skip and starts from Nxxx program line;
M98:Pxxx Lyyy to use sub program xxx, times is yyy;
M99:Back to use sub program;
M87: Number of workpiece plus 1 if No.5 processing parameter set as 0; M00:Pause
100
M01:Program could stop, input X41 and pause when execute M01;
M02:Program end;
M30:M05, M09 program end; M20:Repeat the program automatically;
M500:Read joint coordinate of absolute motor J1-J6 Xs Ys;
M501-M508:Readjoint coordinate of the encoder of J1-J6XsYs separately; M312-
M319:Clear the current user coordinate of XsYsABCXYZ separately;
M412-M419:Clear the joint coordinate of J6XsYsJ4J5J1J2J3 respectively;
39 Use program M97, M98, M99
Skip with none-condition
M97 Pxxx skip to the line number which is specified by P without addition;
Use sub program
In this controller the subroutine should be an independent program.
M98 Pxxx Lyyy unconditionally call subroutine instruction. P is to specify the name and
path of subroutine call, L refers to the calling times for address of subroutine.
The M98 instruction can be omitted, format: PP file name, the file name can be hidden files, the
first character of hidden files must be "HIDEFILE" at the beginning. Such as the file
"HIDEFILE01", this program in the program area is not displayed, can use the instruction
M98/G65 PHIDEFILE01 or M98/G65 P*01 or PP*01 or PPHIDEFILE01 when calling.
For example:
P sub/1390 means subroutine is tmp/NC/sub/1390
Note:
1. tmp/NC/ is the system's default path, sub is a folder for the following
2. The subroutine must be a independent program.
3.Method of the main program in USB calls the subroutine in USB: P[or P].
For example:
M98 P[A1234 means calling the subroutine A1234 in USB;
M98 P]SS12 means calling the subroutine SS12 in USB;
PP[FFDE means calling the subroutine FFDE in USB;
It needs to write the path of file if call the subroutine in folder of USB.
There must be space in front of L(Subroutine calling times). Return to the next program
segment of main program when subroutine running to the end.If the program contains a fixed
sequence or repeated pattern, then the sequence or pattern can be compiled to subroutine to save
in memory storage in order to programme easily, the subroutine can be called by main program
which is also can be called by another subroutine.
M99 is an instruction of ending subroutine return, must have this instruction to end the
subroutine.
Note:
1) M99 in the main program is the same as M02;
2) M99 with P in the main program is the same as M97;
3) M99 returns to main program call in subroutine is in the next line;
4) M99 with P in the subroutine returns to P program line in main program;
The Sub-program can embedded call as follow :
For example:
101
The calling instruction can be used for 9999 times at the most.
40 Macro program
1.Input instruction: WAT
Waiting for the input port X valid or invalid instruction Format: WAT+ (-) X
Note: "+" to means the input is effective;
"-" means the input is invalid;
"X" means the input port X00-X47; see the I/O diagnosis;
2.The output instruction: OUT
Set the output port Y is valid or invalid instruction Format: OUT +(-)Y
Note: "+" means the output is effective;
"-" means the output is invalid;
"Y" means the output port Y00-Y31; see the I/O diagnosis;
3.Variable and assignment: =
1) #0--#20 local variable: local variables only can be used to store data in macro program,
such as a result of operation, when power is off, the local variables are initialized to the empty.
The argument assignment to the local variable when calling the macro program.
2) #21--#999 global variables: The meanings are the same in different macro program.
When power is off, the variable #21--#100 is initialized to zero, the variable #101--#999 data is
saved not to lose even if the power is off.
3) #1000-- system variable: the system variables are used to change various data when
reading the running CNC. For example, the current position and the compensation of tool.
Special note: macro variables #100--#155 and #190--#202 have been used by the system, users can not use.
The I/O variables:
#1800: X00-X07(D0-D7)
#1801: X08-X15(D0-D7)
#1802: X16-X23(D0-D7)
#1802: X16-X23(D0-D7)
#1803: X24-X31(D0-D7)
#1804: X32-X39(D0-D7)
#1805: X40-X47(D0-D7)
#1806: X60-X67(D0-D7)
#1808: Y00-Y15(D0-D15)
#1809: Y16-Y31(D0-D15)
Format:#i=Expression
4.The arithmetic and logic operation Table:
Function Format Note
Definition #i = #j
Addition Subtraction #i = #j + #k ;
Multiplication #i = #j - #k ;
Division #i = #j * #k ;
#i = #j / #k ;
102
Sin Asin Cos Acos Tan #i = SIN(#j) ;
Atan #i = ASIN(#j);
#i = COS(#j) ; 90.5 degrees mean 90
#i = ACOS(#j); degrees 30 minutes
#i = TAN(#j);
#i = ATAN(#j);
Square root Absolute #i = SQRT(#j);
value Rounding off #i = ABS(#j) ;
Round down Round up #i= ROUND(#j);
Natural logarithm #i = FIX(#j);
Exponential function #i = FUP(#j);
#i = LN(#j);
#i = EXP(#j);
Or Exclusive or #i = #j OR #k ; #i Executing with binary
And = #j XOR #k ; system
#i = #j AND #k ;
5. Unconditional transfer: GOTO N
Transfer to the program line with sequence number n, appears error when specifying
beyond the 1-99999, could use expression to specify the sequence number.
For example: GOTO 5, GOTO #100
6. Conditional transfer: IF (Conditional expression) GOTO or THEN
If the conditional expression specified is met, execute this segment; if the conditional
expression specified is not meet, execute the next segment.
For example: IF (#100 EQ 2) THEN #100=5
IF (#101 GT 2) GOTO 6
Operation meaning: EQ equal
NE not equal
GT greater than >
GE greater than or equal LT less than <
LE less than or equal
7. Loop: WHILE (conditional expression) DO 1, 2, 3
Specifies a conditional expression in front of WHILE. When the specified conditions are
met, execute the program between DO and END. Otherwise, turn to the program line after END.
Cycle of the embed is 3 at the most.
For example:WHILE (#100 LT 3)DO 1
……
WHILE (#103 EQ 5)DO 2
……
WHILE (#200 GE 20)DO 3
……
END 3
…… END 2
…… END 1
8. Non-mode to call macro program:G65
Format: G65 P- L- <A-B-C-...... Argument passing data >
P is the name of macro program, L is the calling times,A B C are argument, the name of
argument as follows:
#0->A, #1->B, #2->C, #3->D, #4->E, #5->F, #6->H, #7->I, #8->J, #9->K, #10->M, #11->Q,
#12->R, #13->S, #14->T, #15->U, #16->V, #17->W, #18->X, #19->Y, #20->Z.
103
Special attention: The address G, L, N, Q, P can’t be used in argument.
For example:
Main program:9000 G00 X0 Z0
G65 P8000 L1 A5 B6 G0 X0 Z0
M30
Macro program:8000 N1 #2=#0+#1
N2 IF (#2 EQ 10)GOTO 4
N3 GOO X#2
N4 G00 Z#1
N5 M99 ;Return
9. Mode to call macro program:G66 G67
G67 instruction is to cancel G66 instruction.The format is the same as G65.
For example:
Main program:9000 G00 X0 Z0
G66 P8000 L2 A5 B6 A8 B1
A9 B10 G67 M30
Macro program:8000
N1 #2=#0+#1
N2 IF (#2 EQ 10)GOTO 4
N3 GOO X#2
N4 G00 Z#1
N5 M99 ;Return
10. Prompt dialog
Format: MSG(parameter) or MSG[parameter]; if parameter is information string, pause.
Note:This instruction usually be used in NC program(not macro).
After prompting dialog, controller switch into pause status automatically.
Format : STAF(parameter) or STAF[parameter]; not pause if the parameter is information
string.
41 User-defined macro program(G101—G170,M880—M889)
Must use PC to edit and copy into controller.
1. G101-G170 is macro program of G code, correspond to ProgramGxxx, use instruction of
robot controller.
2. M880-M889 is inner macro program, correspond to macro ProgramUser0 - ProgramUser9,
including inner macro programs of robot controller:
1)Output:OUT
Format:OUT+(-/A)Y(M)**+
Note: “+” means output effective;
“-” means output invalid;
“A” means output reversal(effective to invalid, invalid to effective);
For example:OUT+Y5-Y7+Y9+Y11-Y15
Mean:Y5,Y9,Y11 output effective; Y7,Y15 output invalid
For example:OUT+M12-M13+Y14+Y8-Y16 Mean:M12,Y14,Y8 output effective; M13,Y16
output invalid
2)Wait instruction:WAT
Wait X, Y, M effective or invalid
Format:WAT+(-)X(Y/M)**+(-)X**+(-)X**+(-)X**+(-)X**+(-)X**
Note:“+” wait for effective;
“-” wait for invalid;
Y or M only to be one or none, X could be used many times.
2.1 The longest time of WAT:MAXWAT Format:MAXWAT****
Note:The range is 0-99999, unit is ms.
104
Controller will alarm and quit the running program when time is over.
If value is 0 or MAXWAT instruction alone means the function is disabled, namely no
limit in the longest time.
2.2 Hold time for meeting condition of WAT:HOLDWAT
Format:HOLDWAT****
Note:The range is 0-99999, unit is ms.
If value is 0 or HOLDWAT instruction alone means the function is disabled, namely no
limit in the hold time.
2.3 The longest wait mode:MODWAT
This instruction work with MAXWAT
Format: MODWAT1/MODWAT2/MODWAT3/MODWAT4;
Default: MODWAT1
MODWAT1 the controller will alarm and quit when time is over;
MODWAT2 the controller will alarm and continue to run;
MODWAT3 not alarm and quit when time is over;
MODWAT4 not alarm and continue to run.
For example: Wait for 5 seconds to get X0 signal failed, it will alarm No.9
MODWAT4
MAXWAT5000
WAT+X0
IF (-X0) THEN
OUT+M89
ERREXIT
ENDIF
2.4 Delay: PAUS
Format:PAUS****
Note:The range is 0-99999, unit is ms.
2.5 Assignment:=
Assignment for variable
Format:=
Example: #251=890.34
2.6 Prompt dialog
Format:MESSAGEBOX(parameter 1);parameter 1 is information string.
Also could be abbreviated as MSG(parameter 1).
2.7 Information of changing tool
Format:STATUSINFO(parameter 1);parameter 1 is information string.
Also could be abbreviated as STAF(parameter 1).
Note: If only use STATUSINFO or STAF or STATUSINFO() or STAF() , it will close the
current prompt.
2.8 Condition instruction: execute if meet condition, otherwise skip.
Format: IF (Relay or input point or macro variable) THEN
ENDIF
+Mxx means relay is effective.
-Mxx means relay is invalid.
+Xxx means input point is effective.
-Xxx means input point is invalid.
+Yxx means output point is effective.
-Yxx means output point is invalid.
+#xx means macro variable is not 0.
-#xx means macro variable is 0.
105
2.9 Move coordinate axis
Format : MOVE(parameter G, parameter F, parameter XYZABCXsYs,parameter W)
The first parameter is G90 or G91 to specify it is relative or absolute;
F to specify the speed, XYZABCXsYs to specify the coordinate of machine;
W to specify some input signal satisfy the condition, it will stop,
for example:W+5 means it will stop when X5 input point is effective.
2.10 Set the current user coordinate and save
Format: SETWK(parameter XYZABCXsYs);
2.11 Go to some line:GOTO xx
2.12 Return:RETURN
106
Chapter 5 User Technique
5.1 Technique for weld
Main introduction about operation, parameter and program path of welding. Setting:
Including <Equipment> and <Main setting>.
Equipment: Be used for<Swing weld>,<Parameter>and<Condition for points>. Main
setting: Be used for <Setting for equipment>and<Main setting>.
It will works with tool coordinate and user coordinate.
5.1.1 Relative parameter
(1) Other parameter
★ 330,Interface and function of controller(11 Weld;12 Palletizing;13 Painting)
109
(2)X01 is alarm of welder, this is always-open PLC
110
(7) The controller connect with welder MIG-350R
Usually build user coordinate system with teaching status, steps as follow:
111
(a ) Press “F8 choose coordinate” or “F5 MDI” to choose corresponding user
coordinate system(G54-G59).
(b) Move axis to fixed position(The position is easy for measure), measure the
distance from this point to the corresponding zero point of user coordinate system.
(c) Press “F7” to set P1P2P3 points(Corresponding to F4F5F6).
3-points: P1 is original point O, P2 is direction of +X, P3 is direction of +Y.
Press “Start”, the status will show “O”, then press F4F5F6 back to the last setting point
with the current joint speed in manual so that modify. Press “Start” to open or close this function,
after executing once operation, it will be closed automatically.
The user coordinate system has been set already. The corresponding value will be shown in
the interface of coordinate system. The value is deviation value between user coordinate system
and world coordinate system.
113
5.1.6 Example for weld
Teaching program:
G54 T1 ;G54 user coordinate system, T1 tool coordinate system
AA1000 ;The welding current correspond to output analog 3.33V of controller
VV1500 ;The welding voltage correspond to output analog 5V of controller
MOVJ VJ=80.0 PL=9.0 ;Smooth PL=9,80% rapidly speed to program point1
MOVJ VJ=50.0 PL=9.0 ;Smooth PL=9,50% rapidly speed to program point2
MOVJ VJ=25.0 PL=0 ;Smooth PL=0,25% rapidly speed to program point3
AS3 ;Start arc weld, No.3 technique parameter
WS3 ;Start swing weld, No.2 technique parameter
MOVL V=100 PL=0 ; From program point 3 weld to program point 4 with 100mm/min
WE ;End swing weld
AE3 ;End arc weld
MOVJ VJ=50.0 PL=9.0 ;Smooth PL=, 50% rapidly speed to program point5
MOVJ VJ=50.0 PL=9.0 ;Smooth PL=9, 50% rapidly speed to program point1
M02 ;End
5.1.6 Sample for the successive direct and inverse arc welding
G54T1 ;invoke tool coordinate system T1 and user coordinate system G54
MOVJ ;all joints move rapidly to P00 standby
MOVJ ;all joints move rapidly to P01 near start point
MOVL V=50 ;move to start point P02 in straight way
AS2 ;invoke group NO.2 basic parameter of ark strike
MOVL V=5 ;execute welding in straight way till point P03
MOVC ;execute welding in arc way,through P04to P05
114
MOVC ;execute welding in arc way,through P08to P09
MOVL ;execute welding in arc way till P10
AE2 ;invoke group NO.2 basic parameter of arc failure, end weld
MOVL V=50 ;move to end point P11 in straight way
MOVJ ;all joints rapidly move to safe position
M02 ;program completed
This parameter is used for basic parameter. To press Enter into dialog to input number [1—
99] of depalletizing parameter including:
Type: palletize or depalletize, these two are reverse process.
Sequence of line, column and layer(only when value is 0, is the sequence
default valid): to set sequence of robot operating.
Number of line, column and layer: it refers to number you need. Distance between lines and
columns;
Attention: if no specified or be specified to be 0, the parameter is invalid, it will be calculated
automatically according to end of teach and number of lines, columns and layers.
Number of approach point: 2 point at most;
Number of back point: 2 point at most:
Approach speed: speed from approach point 2 to 1 to offset pilling point (mm/s).
115
Back speed: speed from offset pilling point to back point 1 to 2 (mm/s).
Offset distance between idling arrival and leaving from pilling point: distance
between offset pilling point and pilling point (mm).
Speed between idling arrival and leaving from pilling point: speed between
offset pilling point and pilling point (mm/s).
Type of layout:
0 means parameter setting generates the same layout in every
layer (teach posture at datum point);
1 means setting each layer the same as first layer, if no setup,
then quit;
2 means different layout in odd and even layer, odd layer
correspond to first layer, even layer correspond to second layer.
If no setup, then quit;
3 means customization. You need specify layouts of each layer.
★ 602,The teach for piling point of depalletizing
To record original point, line endpoints, column endpoint, layer endpoint
in teach function.
★ 603,The teach for approach and back point of depalletizing
To record approach point 1, approach point 2, back point1, back point 2
in teach function.
★ 604,The special set for each floor layout number of depalletizing
If value is 0, the parameter is invalid;
If value is 1, you need to set layout of the first layer(606/607);
If value is 2, you need to set layout of the first and second
layer(606/607);
If value is 3, you need to set layout of each layer(606/607).
★ 605,The special set for each floor height of depalletizing
Only when height of certain layer is special, is it valid. If without setting,
the controller will calculate automatically according to parameters and
teach points.
★ 608,The set or teach for special floor with special approach and back point
To teach approach point 1, approach point 2, back point1, back point 2
on special layer.
Add D before number to delete the setting according to prompt. For
example, D5 means to delete special approach and back points in the
fifth layer.
2. About setting of layout, there is 99 types of layouts including number 1--99.
type of layout refers to layout pattern in one layer. If the layout type is 0, the layout
type is set unnecessarily.
116
★ 606,The set or teach for special regular layout data of depalletizing
When layout is regular, this parameter is enabled. You need to teach
original point, line endpoint, column endpoint, and number of lines and
column.when the type of layout is 1or 2 or 3, it is necessary to set
parameter 604 and 606, or 607.
★ 607,The set or teach for special ruleless layout data of depalletizing
When layout is irregular, you need to teach the position of every
workpiece, 10 workpieces are allowed at most now.
3. Posture of end effector
★ 613, Instruction M before movement of depalletizing(880—889)
Customer instruction M executed automatically before depalletiaing. For
example, 880 means system will execute M880 automatically. If don’t
have a need, set value as 0.
M880-M889 correspond to macro program ProgramUser0-programUser9,
the input/output can be edited by WAT/OUT in program[ refers to system
instruction(41)User-defined macro program], import it into controller after
finishing edition. Output instructions as follows, for example, OUT+M330,
means output of Y00 is valid.
M330:Y00; M331:Y01; M332:Y02; M333:Y03; M334:Y04; M336:Y06;
M337:Y07; M51:Y08; M56:Y09; M49:Y10; M48:Y11; M343:Y13;
M344:Y14; M345:Y15; M53:Y18; M54:Y19; M50:Y20; M57:Y21;
M352:Y22; M353:Y23; M354:Y24; M355:Y25; M356:Y26; M357:Y27;
M231:Y28; M232:Y29; M360:Y30; M361:Y31;
★ 614, Instruction M at the approach point 1(880—889)
Execute depalletizing motion at the approach point 1.
★ 615, Instruction M approach to the offset pilling point (880—889)
Execute depalletizing motion at the offset pilling point.
★ 616, Instruction M close to the pilling point (880—889)
Execute depalletizing motion close to the pilling point.
★ 617, Instruction M back to the offset pilling point (880—889)
Execute depalletizing motion back to the offset pilling point
★618, Instruction M at the backing point 1 (880—889)
Execute depalletizing motion at the backing point 1.
4. Copy and delete data
★609,Copy data of some number depalletizing
★610,Copy data of some number layout mode
★611,Delete data of some number depalletizing
★612, Delete data of some number layout mode
117
5.2.2 Palletizing instruction
(1)Whole operation of depalletizing PW**
Before executing PW**, controller will execute PR** once automatically to
reset the current value.
Note:
1) The macro variable of depalletizing #9001--#9099 correspond to total
number of each number of depalletizing, all finished if it is negative number.
2) The macro variable of depalletizing #9101--#9199 correspond to the current
layer number of each number of depalletizing.
It is enabled also to depalletize in another way that you can program by translation
118
instruction SN* instead of above manners. Firstly you need to set a translation value
PX*, then accumulate or regress the value that all has been invoked. Although this
method is complex to program, it is more accessible and flexible for user.
119
Chapter 6 PLC
6.1 Function of PLC
The control system enables PLC function. It can manage all I/O ports, online logic judgment
of internal auxiliary relay and count through programmable I/O, auxiliary relay and timer to detect
input port and control output port and date communication with core.
Edit PLC:
①Edit PLC on controller directly;
②Edit PLC on PC(Use the PLC software of SZGH CNC which is SZGHPLCS.EXE, open
PLC.LAD file could be edited;After editing and saving, then lead into controller will be fine, there
are 3 files: (PLC.LAD) ,( PLC.PLC), (PLC-NOTE).Then restart controller will be fine.
Execute instruction: Table of instruction Memory of program: 10000 steps
Execute cycle: Super high-speed is 2ms, high-speed is 8ms, low-speed is 100ms Mode:
Sequence①,Cycle②
Basic: Inner relay,Timer,Counter,Input relay X,Output relay Y
Note:
1 Sequential execution refers to PLC execution perform the files of instruction table step
by step.
2 Loop execution refers to PLC executes from the start to the end of table. It will execute
from the start of table again after finished table once.
Note:
1),Input X0-X47. X0-X7 and X40-X47 could be 0V effective, also could be 24V effective (Select by pin of
connection board), X8-X39 is 0V effective.
2), Output Y0-Y31, 0V effective.
121
Execute Lubrication when this relay is effective.
27 M51 Lubrication ( output, Use M32/M33 to
control )
122
Strop program when this relay is
42 M115 Remote stop effective.(Input) Use external HALT
button.
Program will run automatically when this
43 M122 Run program
relay is effective(Status)
Program will be pause when this relay is
44 M123 Program pause
effective(Status)
45 M128 Stop J1 Stop J1 when it is effective.(Input)
46 M129 Stop J2 Stop J2 when it is effective.(Input)
47 M130 Stop J3 Stop J3 when it is effective.(Input)
48 M131 Stop J4 Stop J4 when it is effective.(Input)
49 M132 Stop J5 Stop J5 when it is effective.(Input)
50 M318 Stop J6 Stop J6 when it is effective.(Input)
51 M319 Stop Xs Stop Xs when it is effective.(Input)
52 M320 Stop Ys Stop Ys when it is effective.(Input)
53 M200 Running status X move positive
54 M201 Running status X move negative
55 M202 Running status Y move positive
56 M203 Running status Y move negative
57 M204 Running status Z move positive
58 M205 Running status Z move negative
59 M206 Running status A move positive
60 M207 Running status A move negative
61 M208 Running status B move positive
62 M209 Running status B move negative
63 M210 Running status C move positive
64 M211 Running status C move negative
65 M212 Running status Xs move positive
66 M213 Running status Xs move negative
67 M214 Running status Ys move positive
68 M215 Running status Ys move negative
Status of X backed to zero already
69 M824
backed to zero
Status of Y backed to zero already
70 M825
backed to zero
Status of Z backed to zero already
71 M826
backed to zero
123
Status of A backed to zero already
72 M827
backed to zero
Status of B backed to zero already
73 M828
backed to zero
Status of C backed to zero already
74 M829
backed to zero
Status of Xs backed to zero already
75 M830
backed to zero
Status of Ys backed to zero already
76 M831
backed to zero
Press Reset, M265 is effective, from NC layer to PLC
77 M265 layer, need use PLC to reset
the relay.
M282--M28 Bus type Connection status of number 1-8, normal when
78 effective(Status)
9 connection
Execute corresponding motion when the relay is
79 M290-M297 User-defined effective according to PLC
(Input/Output)
Execute corresponding motion when the relay is
M298--M31 effective according to PLC, status could be saved
80 User-defined
3 after power off
(Input/Output)
81 M317 Be ready Effective when controller is ready(Status)
M321 Execute corresponding motion when the relay is
82 M325 User-defined effective according to PLC
M329 (Input/Output)
Use M3330/M4330-M3377/M4377 to
M330--M37 control; Execute corresponding motion
83 User-defined
7 when the relay is effective according to PLC
(Input/Output)
High-speed or super high-speed of PLC
84 M999
before
85 M1014 Reset emergency, lower the speed
86 M1050 Automatically status when it is effective
87 M1069 Manual status when it is effective
124
6.3 Function module of PLC
6.3.1 Account, timer
Total 16 account(C0-C15), 80 timer(T1-T79),normal 10ms timer is T0---3,T16---31 ; 10ms
totalizer is T4---7 ,T32---47; normal 1s timer is T8---11 ,T48---63;1s totalizer is T12---
15,T64---79.
6.3.2 Basic
1,--[/]: [Basic instruction]:Negation of output winding
125
6.3.3 Definition of logic calculation
Note:1,Parameter C is always address.
2,Range of constant is 0---255.
1,CMP: Comparation of data
Conditions:
0 means 8 bits data, parameter A and B are both address;
1 means 16 bits data, parameter A and B are both address;
2 means 8 bits data, parameter A is address, parameter B is constant;
3 means 16 bits data, parameter A is address, parameter B is constant;
4 means 8 bits data, parameter A is constant, parameter B is address;
5 means 16 bits data, parameter A is constant, parameter B is address;
8 means parameter A and B are both constant.
Rules:
When parameter A>B, evaluation C(low 3 bits) is 1;
When parameter A=B, evaluation C(low 3 bits) is 2;
When parameter A<B, evaluation C(low 3 bits) is 4.
Example 1:
When M77 is effective, condition is 10, means and,parameter A and B are both address.
When address of parameter A 10=10000111, address of parameter B 12=01100001, address of
parameter C 15=00000001.
(2)Or: Parameter C = (Parameter A | Parameter B).
When M77 is effective, condition is 20, means or, parameter A and B are both address.
When address of parameter A 10=10000111, address of parameter B 12=01100001, address of
parameter C 15=11100111.
(3)Exclusive or: Parameter C = (Parameter A ^ Parameter B).
When M77 is effective, condition is 30, means exclusive or, parameter A and B are both
address. When address of parameter A 10=10000111, address of parameter B 12=01100001,
address of parameter C 15=11100110.
(4)Not:Parameter C = (~ Parameter A).
When M77 is effective, condition is 50, means move left,parameter A and B are both
address.When address of parameter A 10=10000111, address of parameter B
11=00000011, address of parameter C 15=00111000.
(6) Move right: Parameter C = (Parameter A >> Parameter B).(Parameter B specify
127
the numbers of bits to move right).
128
When M77 is effective, condition is 50, means move right,parameter A and B are
both address.When address of parameter A 10=10000111, address of parameter B
11=00000011, address of parameter C 15=00010000.
4 , ADD: Data plus
Conditions:
0 means 8 bits data, parameter A and B are both address; 1
means 16 bits data, parameter A and B are both address;
2 means 8 bits data, parameter A is address, parameter B is constant; 3
means 16 bits data, parameter A is address, parameter B is constant; 4
means 8 bits data, parameter A is constant, parameter B is address; 5
means 16 bits data, parameter A is constant, parameter B isaddress;
8 means parameter A and B are both constant.
Rules:
Parameter C = Parameter A + Parameter B.
When M70 is effective, condition is 0,parameter A and B are both address.When address of
parameter A 10=10100111, address of parameter B 20=00000101, address of parameter C
15=01000011.
7 , DIV: Data divide
Conditions:
0 means 8 bits data, parameter A and B are both address;
1 means 16 bits data, parameter A and B are both address;
2 means 8 bits data, parameter A is address, parameter B is constant;
3 means 16 bits data, parameter A is address, parameter B is constant;
4 means 8 bits data, parameter A is constant, parameter B is address;
5 means 16 bits data, parameter A is constant, parameter B is address;
8 means parameter A and B are both constant.
Rules:
Parameter C = Parameter A/Parameter B.
When X00 is effective, condition is 0,parameter A and B are both address.When address of
parameter A 1=10100111, address of parameter B 2=00000101, address of parameter C
111=00100001.
6.3.4 Control the steps
1. END1 : [Control the steps] :The end of the first level
END1 in front of PLC is high-speed, every cycle is 8ms.
130
Condition:
Not jump when M78 is invalid,execute the next segment behind the JUMP.
Jump to the marked position when M78 is effective and execute the next segment.
JUMP number 1-9999.
Note:Jump over 45-49 lines and execute 51 line when X11 is effective.
Execute 45 line when X11 is invalid.
Note :Call and execute the specified sub program when M72 is effective(example CALL 16).
Execute the next instruction after executing CALL when M72 is invalid.
6. SP : [Control the steps] Start sub program
7. SPE : [Control the steps] End sub program
SP to generate a sub program, the number of sub program as the name of sub program, SPE
is the mark of the end of sub program. When the instruction is executing, it will be back to the
main program, SP and SPE to specify the range of sub program.The sub program must be edited
behind END2.
131
SP16 sub program.
Note: Execute sub program SP22 when X11 is effective; Condition of RETN is
satisfied when M285 is effective, then back to the main program directly and execute
13 line.
Execute sub program SP22 when X11 is effective;Condition of RETN is not
132
satisfied when M285 is invalid, then execute 18 line of sub program to the end, then
back to the main program.
133
106 M40--M47
107 M48--M55
108 M56--M63
109 M64--M71
110 M72--M79
111 M80--M87
112 M88--M95
113 M100--M107
114 M108--M115
115 M120--M127
116 M128--M135
117 M200--M207
118 M208--M215
119 M250--M257
120 M258--M265
121 M266--M273
122 M274--M281
123 M218--M225
124 M226--M233
125 M234--M241
126 M242--M249
127 M282--M289
128 M290--M297
129 M298--M305
130 M306--M313
131 M800--M807
132 M808--M815
151 Total of tool
153 The current number of tool-case
155 Number of target tool-case
Note:
1. Odd address could use 8 bits parameter, also could use 16 bits parameter;
2. Even number only use 8 bits parameter, can’t use 16 bits parameter;
3. For 16 bits odd address, including this odd address and a parameter of even number behind;
4. Constant could be 8 bits number at the most.
134
Chapter 7 Connection
7.1 Character of robot controller
High performance industrial level 32 bits ARM+DSP+FPGA
128M(Could be expand to 32G) user storage
800x600 TFT LCD touch screen
USB connection
Power supply of high anti-interference
Hand held
48x32 I/O
2 ways 0-10V analog output
1 way orthogonal input of encoder
6 ways output of motor with brake
135
7.4 Installation connection
Firstly check the controller, power, motor, electrical board is good or not.
Must save some space around, keep air circulation, the position of controller need to be
easy to operate and avoid scalding when machine is working.
Leave away from strong electricity in case of interference, all input signal is the
best not connect with controller directly; Must connect with ground.
Can’t hot-plugging all cables when power on. Put controller into clean and fixed position.
Note:
1, Controller need to install a place which got lightning-protection
2, Controller must be a fixed place in case of vibration
3, Keep controller away from combustible
7.4.1 Connection diagram
136
1. I/O board of input and output
137
2. Relay board of controller
140
7.4.4 DB15 connecting with J1-J6 of pulsed driver
the socket connects to pulsed servo driver.
J1-J6 pulse driver DB15 pin(6 pairs) 301H driver 302H driver
DB25 DB25
Signal Pin I/O Function
Pinhead Pinhead
CP+/CP- 1/9 OUT Pulse signal 6/18 6/18
DIR+/DIR- 2/10 OUT Direction signal 7/19 7/19
EN 3 OUT Enable driver 23
Remove driver
INTH 4 OUT 10
alarm
+24V 5/11 OUT 24V Power 11
ALM 12 IN Driver alarm 12 12
0V 13 OUT Ground of power 13,21 13,25
RS485+/RS485- 15/8 485+/485- 1/25 5/17
`J1-J6 Pulsed Driver DB15 Pinhead(2 pairs)
CP+/CP- 1/9 OUT Pulse signal 3/15
DIR+/DIR- 2/10 OUT Direction signal 4/16
RS485+/RS485-: connect to Modbus communication signal of driver, OV must
connect to OV port of driver.
EN: enable driver when output OV
INTH: reset driver when output OV
ALM: Imputing OV means driver alarm, frequent on signal. If it is frequent off signal,
ALM of all driver should be threaded together, then connect to one ALM signal of all,
and X20 needs to changing into normal close in PLC.
Change into
141
7.4.6 DB9 connecting with CN9 of spindle orthogonal encoder
The socket connects to encoder on the device.
CN9 Signal of main spindle encoder DB9 Pinhead(4 pairs)
Signal Pin I/O Function Active level
0V 4 OUT Ground of power 0V
+5V 1 OUT 5V Power +5V
PA+/PA- 5/7 IN A signal 5V
PB+/PB- 3/6 IN B signal 5V
PC+/PC- 2/8 IN Z Synchronization signal 5V
Attention:
1. Signal of encoder outputs in a long-wire mode, voltage is +5V.
2. Signal wire must use shielded twisted pair cable, the length can’t be over 20m.
Schematic diagram of input signal PA,PB,PC of encoder:
142
Chapter 8 Debugging
8.1 Steps
1. Ready before debugging;
2. Set No.56 number of driver;
3. Modify PLC according to the requirement;
4. Test the motor when power on, not alarm;
5. Relative parameter of machine:Reduction ratio,Length of link rod,coupling relation,
Reversal gap;
6. Set parameter of motor in controller: Absolute encoder;
7. Zero point of robot;
8. Soft limited of each joint;
9. Power on to check the joint coordinate;
10. Set error of location;
11. Accuracy of location;
12. Backup parameter;
13. Test for working;
8.2 Ready for working
Must check the connection before debugging.
1, Make sure the power supply is right(3 phase 380V, ground,sectional area of cable);
2, Make sure the power supply of driver and controller is right(Isolation,220V,sectional
area of cable);
3, Make sure the voltage of brake is right, and it’s DC voltage;
4, Make sure all signal and connection are right(Driver, encoder use Shielded twisted pair
wire, other signal use normal shielded wire)
5, Check all route of connection(Especially AC power, DC24V power, encoder use 5V
power);
6, Try to power on:Level by level to power on.
8.3 Set parameter of driver
1,Code:P1=1(Default );
2,Set No.56 parameter of driver in each joint, set as 1-8 correspond to J1-J6\Xs\Ys;
3,Save the parameters of servo driver;
Note: Restart power, the circle in front of coordinate need to be green, otherwise some problems with
bus, please check the set and cable.
144
Robot2 Six axis parallelogram robot(P451=601/2601)
Note: a2 could be not specified, e2 could be 0
palletizingparallelogram robot(P451=442)
147
8.4.3 Reduction ratio of machine, relative parameter No.44-No.60
1,Calculation of electrical gear of vertical multi-joint robot
1),P44=0;
2),Numerator of electrical gear:
J1-J6\Xs\Ys correspond to P45\P47\P49\P51\P53\P55\P57\P59,reduction ratio is x1000.
Example:Reduction ratio of J1 is 121,then No.45=1210000;
3),Denominator of electrical gear:
A,J1-J6 correspond to P46\P48\P50\P52\P54\P56,set as 36000000;
B,Xs\Ys correspond to P58\P60, if it is ration axis then set as 36000;If it is straight
line axis, then set as 10000.
2,Calculation of electrical gear of palletizing robot
The setting way of J1,J4 axis is the same as robot 1-3.The set of reduction ratio of J2,J3 as
follow:
148
3. Calculation of electrical gear in straight line axis 4 of robot: Straight line axis is different
according to the structure, two kinds usually: Lead screw, gear drive(Synchronous pulley).
Calculation of reduction ratio of lead screw
149
Calculation of reduction ratio of rack drive
8.4.4 Coupling relation,relative other parameter No.375-No.385
Coupling relation of robot solve the structure problem,move an joint separately, the other
joint will follow move with ratio relation, if need this joint not move,then it will give the
compensation pulse to let it stay, example: J5J6 coupling, J6 moves when J5 moving, this
movement is the distance of J5 times numerator and divide by denominator.
No.P375 is parameter to set this function.
D2=1 +4 means J1J2 got coupling relation, No.376 and No.377 is numerator and
denominator of coupling;
D3=1 +8 means J3J4 got coupling relation, No.378 and No.379 is numerator and
denominator of coupling;
D4=1 +16 means J4J5 got coupling relation, No.380 and No.381 is numerator and
denominator of coupling;
D5=1 +32 means J5J6 got coupling relation, No.382 and No.383 is numerator and
denominator of coupling;
D6=1 +64 means J4J6 got coupling relation, No.384 and No.385 is numerator and
denominator of coupling;
Example:
1, J5J6 got coupling relation in vertical multi joint serial robot,parallelogram robot;
2, J4J5 and J5J6 got coupling relation in Vertical mulit-joint L wrist robot;
3, SCAR is composite lead screw, the reduction ratio is 360/T of lead screw;
4, Palletizing without coupling;
5, The 4th 5th axis got coupling in pole coordinate robot;
6, The 4th 5th axis got coupling in reciprocating machine1; 7,The 4th 5th axis got coupling
in reciprocating machine2;
8.4.5 Reversal gap, relative axis parameter No.30-No.37
Use to set when J1-J6/Xs/Ys axis move reversal, the drive got reversal gap. When the axis
involves reversal motions, system will invoke the value to compensate automatically. Unit:μm.
8.5 Each axis parameter of driver in controller
1 , Direction of servo motor
No.38-No.43 axis parameter set the motor direction of J1-J6/Xs/Ys;
2 , Mode of floating back to zero point
No.62=11111111011 in axis parameter to set each axis;
3 , Bus absolute function
150
No.300=111111110 in other parameter, if it is absolute motor, then set as 1;
4, Address of absolute encoder
No.301=92,No.302=91,No.303=90 in other parameter;
5, Number of pulse when motor in each cycle
P304/P305/P306/P307/P308 in other parameter=131072, corresponding to J1-J6/Xs/Ys
joint;
6, Coordinate distance when motor in each cycle
Set P309/P310/P311/P312/P313=360000000 in comprehensive parameter which
correspond to J1-J6/Xs/Ys joint, set as 10000000 if it is straight line axis;
7, Denominator of coordinate distance when motor in each cycle
Set P320/P321/P322/P323/P324= reduction ratio in comprehensive parameter which
correspond to J1-J6/Xs/Ys joint;
8, Direction and coordinate of machine:
1) Move J1-J6 in teach, remember the corresponding coordinate of joint;
2)In MDI to run M500, read the absolute coordinate to check if it is the same as before or
not, if not the same, then change the symbol of P309/P310/P311/P312/P313 in comprehensive
parameter, example: J1 is not the same, then P309=360000000, change it into P309=-360000000;
3)Repeat step 1) 2) two times until the coordinate is the same;
Note:The little circle should be green when using M500 to read, otherwise something wrong with the
bus, please check the set and cables.
9,Zero point of robot joint
Move J1-J6/Xs/Ys near the zero point in teach mode, set P314/P315/ P316/P317/P318 in
comprehensive parameter(correspond to J1-J6/Xs/Ys axis), press “Enter”, then press “E” to clear,
and set current position as the zero point of joint.
10,Set soft limit of each joint
P18-P29 axis parameter to set soft limit of each joint;
11,Set error of location and position
1)Error of location
If need make sure the location position,when PL=0 in program, controller will wait the
motor until it reaches to the position; PL≠0, not to wait.
It will takes time of program, this is about driver parameter, strong rigidity, reasonable,
short time.
Set parameter of driver, No.511-No.588 correspond the relative parameter.
(1) P511/P521/P531/P541/P551/P561/571/P581 correspond to No.8 parameter of J1-
J6/Xs/Ys. the bigger value, the bigger current;
(2) P512/P522/P532/P542/P552/P562/572/P582 correspond to No.9
J1-J6/Xs/Ys, the bigger value, the bigger noise;
(3) P513/P523/P533/P543/P553/P563/573/P583 correspond to No.10 J1-J6/Xs/Ys, the
bigger value, the bigger vibration;
(4) P514/P524/P534/P544/P554/P564/574/P584 correspond to No.11
J1-J6/Xs/Ys, the bigger value, the stronger rigidity, more accuracy;
Attention:
Set error of position applies to requirement for accurate location. It will keep the robot in accurate place,
while providing reference for parameter of servo driver.
2) The error of position
This error is in PLAY or remote mode, the error between ideal position and the real
feedback position. It will be alarm when over the set range.
(1) Electrical gear of feedback
Comprehensive parameter P210-P214=10000, correspond to the numerator of J1-J6/Xs/Ys;
Comprehensive parameter P215-P219=131072, correspond to the denominator of J1-J6/Xs/Ys;
(2) The error of alarm
151
Could use this in highly requirement for accuracy, comprehensive parameter P200-P204
correspond to J1-J6/Xs/Ys joint, if the tracking error is over set in progress, it will be
alarm ; comprehensive parameter P205-P209 correspond to J1-J6/Xs/Ys, if the tracking error is
over set when stopping, it will be alarm.
Note:
Error of position usually be used in case of circuit fault, wrong parameter, wrong driver to cause wrong
motion, in case of crushing.
12,Set comprehensive parameter
P41 in controller, backup the current parameter.
No.42 to restore the parameter.
8.6 Calibration accuracy of location and repeat location of robot
1,First calibration
In teach mode, switch into world coordinate, move X Y Z to check it is straight or not, if
not straight, then need to check electrical gear of driver, number of pulse in controller, reduction
ratio, link rod parameter.
2,Accuracy calibration
Edit a segment to run straight, run the segment with a reference to see it is straight or
not.Or use measure to check.
8.7 Continuous running test of robot
Teach edit program with different posture of robot, continuous to run and check the
tracking error of each axis is changing or not, error can’t be over 2 unit changes at the same
position.
152