Robot Adjustment Program (Bfrm.prg) - Mitsubishi Electric CR750-Q Instruction Manual

Cr750/cr751/cr760 series
Hide thumbs Also See for CR750-Q:
Table of Contents

Advertisement

(2) Robot adjustment program (BFRM.prg)

Robot No.1 (Master)
'#### Teaching point ####
'PPL1,PPL2,PPL3
'PPK1
'
'#### Calcurated point ###
'PFR1
'
'##### Main process #####
*MAIN
' <1> Theching three point(PPL1, PPL2, PPL3) for create the
common frame. Execute next line.
PFR1=Fram(PPL1,PPL2,PPL3) ' Calculate the origin data of
'
'** Set the common TOOL data between Robot 1 and Robot 2 **
' <2> Teaching the operation position of Robot 1 to 'PPK1'
variable.
' <3> Input the theching data of 'PPK2' variable of Robot 2.
Execute next three lines.
PBT=(PPK1+PPK2)/2
PTL1=Inv(PPK1)*PBT ' Calculate the common TOOL data for
Tool PTL1
End
'
Note 1) Set the common frame coordinates to robot No.1 and robot No.2. Refer to
ment 1: Adjustment of the common base coordinates"
Note 2) Use the setting of the robot No.1 base coordinates for robot No.2 base coordinates. Refer to
697, "(1) Adjustment 1: Adjustment of the common base coordinates"
Note 3) Set the common tool in the robots. Refer to
tool"
for details.
Robot CPU No.2
' Common coordinate
' Picking point
' Origin point of the common
coordinate (Robot 1)
common frame of Robot 1.
' Calculate the center position
between Robot 1 and Robot 2.
Robot 1.
Note 3)
'#### Teaching point ####
'PPL1,PPL2,PPL3
'
'#### Calcurated point ###
'PFR1
'PFR2
Note 1)
'PBASE
'
'##### Main process #####
*MAIN
' <1> Input the origin data of common fram of Robot 1 to
'PFR1' variable.
' <2> Theching three point(PPL1, PPL2, PPL3) for create the
common frame. Execute next line.
PFR2 =Fram(PPL1,PPL2,PPL3) ' Calculate the origin data of
'
' The base coordinate of Robot 2 will be set same as the
robot1's.
PBTMP=PFR2*Inv(PFR1)
PBASE=Inv(PBTMP)
Base PBASE
'
'** Set the common TOOL data between Robot 1 and Robot 2 **
' <3> Teaching the operation position of Robot 2 to 'PPK2'
variable.
' <4> Input the theching data of 'PPK1' variable of Robot 1.
Execute next three lines.
PBT=(PPK1+PPK2)/2 'Calculate the center position between
PTL2=Inv(PPK2)*PBT 'Calculate the common TOOL data for
Tool PTL2
End
'
for details.
Page 698, "(2) Adjustment 2: Setting of the common
Cooperative operation function Appendix-695
Robot No.2 (Slave)
Robot CPU No.3
' Common coordinate
' Origin point of the common
coordinate (Robot 1)
' Origin point of the common
coordinate (Robot 2)
' Base coordinate point
common frame of robot 2.
'Set the Base coordinate.
Robot1 and Robot 2.
Robot 2.
Page 697, "(1) Adjust-
for details.
7Appendix
Note 2)
Page

Hide quick links:

Advertisement

Table of Contents
loading

This manual is also suitable for:

Cr750Cr751-qCr751-dCr760-dCr760-qCr750-d

Table of Contents