Servo Float Function Manual
Servo Float Function Manual
ServoFloat
Function Manual
Motoman, Incorporated
805 Liberty Lane
West Carrollton, OH 45449
TEL: (937) 847-6200
FAX: (937) 847-6277
24-Hour Service Hotline: (937) 847-3200
COMPLETE OUR ONLINE SURVEY
Motoman is committed to total customer satisfaction! Please give us your feedback on the technical manuals you
received with your Motoman robotic solution.
To participate, go to the following website:
http://www.motoman.com/forms/techpubs.asp
The information contained within this document is the proprietary property of Motoman, Inc., and may not be
copied, reproduced or transmitted to other parties without the expressed written authorization of Motoman,
Inc.
©2007 by MOTOMAN
All Rights Reserved
Because we are constantly improving our products, we reserve the right to change specifications without
notice. MOTOMAN is a registered trademark of YASKAWA Electric Manufacturing.
5GTXQ(NQCV
%JCRVGT
+PVTQFWEVKQP
This manual provides system information for the ServoFloat Control Function and contains
the following sections:
5'%6+10+0641&7%6+10
Provides general information about the structure of this manual, a list of reference documents,
and customer service information.
5'%6+105#('6;
This section provides information regarding the safe use and operation of Motoman products.
5'%6+105'481(.1#6+05647%6+105
Provides detailed information about the ServoFloat Control Function.
4GHGTGPEGVQ1VJGT&QEWOGPVCVKQP
For additional information refer to the following:
• NX100 Controller Manual (P/N 149201-1)
• Concurrent I/O Manual (P/N 149230-1)
• Operator’s Manual for your application
• Vendor manuals for system components not manufactured by Motoman
%WUVQOGT5GTXKEG+PHQTOCVKQP
If you are in need of technical assistance, contact the Motoman service staff at (937) 847-3200.
Please have the following information ready before you call:
• Robot Type (ServoFloat)
• Application Type (arcwelding, spot welding, handling)
• Robot Serial Number (located on back side of robot arm)
• Robot Sales Order Number (located on back of controller)
(KPCN RCIG
(WPEVKQP/CPWCN
%JCRVGT +PVTQFWEVKQP
Notes
RCIG (KPCN
5GTXQ(NQCV
%JCRVGT
5CHGV[
+PVTQFWEVKQP
+VKUVJGRWTEJCUGT UTGURQPUKDKNKV[VQGPUWTGVJCVCNNNQECNEQWPV[UVCVG
CPFPCVKQPCNEQFGUTGIWNCVKQPUTWNGUQTNCYUTGNCVKPIVQUCHGV[CPFUCHG
QRGTCVKPIEQPFKVKQPUHQTGCEJKPUVCNNCVKQPCTGOGVCPFHQNNQYGF
:HVXJJHVWWKDW\RXREWDLQDQGUHYLHZDFRS\RIWKH$16,5,$1DWLRQDO6DIHW\6WDQGDUGIRU
,QGXVWULDO5RERWVDQG5RERW6\VWHPV7KLVLQIRUPDWLRQFDQEHREWDLQHGIURPWKH5RERWLF,QGXVWULHV
$VVRFLDWLRQE\UHTXHVWLQJ$16,5,$57KHDGGUHVVLVDVIROORZV
5RERWLF,QGXVWULHV$VVRFLDWLRQ
9LFWRUV:D\
32%R[
$QQ$UERU0LFKLJDQ
7(/
)$;
,17(51(7ZZZURERWLFVRQOLQHFRP
8OWLPDWHO\WKHEHVWVDIHJXDUGLVWUDLQHGSHUVRQQHO7KHXVHULVUHVSRQVLEOHIRUSURYLGLQJSHUVRQQHO
ZKRDUHDGHTXDWHO\WUDLQHGWRRSHUDWHSURJUDPDQGPDLQWDLQWKHURERWFHOO7KHURERWPXVWQRWEH
RSHUDWHGE\SHUVRQQHOZKRKDYHQRWEHHQWUDLQHG
:HUHFRPPHQGWKDWDOOSHUVRQQHOZKRLQWHQGWRRSHUDWHSURJUDPUHSDLURUXVHWKHURERWV\VWHPEH
WUDLQHGLQDQDSSURYHG0RWRPDQWUDLQLQJFRXUVHDQGEHFRPHIDPLOLDUZLWKWKHSURSHURSHUDWLRQRIWKH
V\VWHP
(KPCN RCIG
(WPEVKQP/CPWCN
%JCRVGT 5CHGV[
7KLVVDIHW\VHFWLRQDGGUHVVHVWKHIROORZLQJ
6WDQGDUG&RQYHQWLRQV 6HFWLRQ
*HQHUDO6DIHJXDUGLQJ7LSV 6HFWLRQ
0HFKDQLFDO6DIHW\'HYLFHV 6HFWLRQ
,QVWDOODWLRQ6DIHW\ 6HFWLRQ
3URJUDPPLQJ2SHUDWLRQDQG0DLQWHQDQFH6DIHW\ 6HFWLRQ
5VCPFCTF%QPXGPVKQPU
7KLVPDQXDOLQFOXGHVWKHIROORZLQJDOHUWV–LQGHVFHQGLQJRUGHURIVHYHULW\–WKDWDUHHVVHQWLDOWRWKH
VDIHW\RISHUVRQQHODQGHTXLSPHQW$V\RXUHDGWKLVPDQXDOSD\FORVHDWWHQWLRQWRWKHVHDOHUWVWR
LQVXUHVDIHW\ZKHQLQVWDOOLQJRSHUDWLQJSURJUDPPLQJDQGPDLQWDLQLQJWKLVHTXLSPHQW
%"/(&3
+PHQTOCVKQPCRRGCTKPIKPC�)'4EQPEGTPUVJGRTQVGEVKQPQHRGTUQPPGNHTQOVJGKOOGFKCVG
CPFKOOKPGPVJC\CTFUVJCVKHPQVCXQKFGFYKNNTGUWNVKPKOOGFKCVGUGTKQWURGTUQPCNKPLWT[QT
NQUUQHNKHGKPCFFKVKQPVQGSWKROGPVFCOCIG
8"3/*/(
+PHQTOCVKQPCRRGCTKPIKPC9#40+0)EQPEGTPUVJGRTQVGEVKQPQHRGTUQPPGNCPFGSWKROGPVHTQO
RQVGPVKCNJC\CTFUVJCVECPTGUWNVKPRGTUQPCNKPLWT[QTNQUUQHNKHGKPCFFKVKQPVQGSWKROGPV
FCOCIG
$"65*0/
+PHQTOCVKQPCRRGCTKPIKPC%#76+10EQPEGTPUVJGRTQVGEVKQPQHRGTUQPPGNCPFGSWKROGPV
UQHVYCTGCPFFCVCHTQOJC\CTFUVJCVECPTGUWNVKPOKPQTRGTUQPCNKPLWT[QTGSWKROGPVFCOCIG
1RWH,QIRUPDWLRQDSSHDULQJLQD1RWHSURYLGHVDGGLWLRQDOLQIRUPDWLRQZKLFKLVKHOSIXOLQXQGHUVWDQGLQJWKHLWHPEHLQJ
H[SODLQHG
RCIG (KPCN
5GTXQ(NQCV
)GPGTCN5CHGIWCTFKPI6KRU
$OORSHUDWRUVSURJUDPPHUVSODQWDQGWRROLQJHQJLQHHUVPDLQWHQDQFHSHUVRQQHOVXSHUYLVRUVDQG
DQ\RQHZRUNLQJQHDUWKHURERWPXVWEHFRPHIDPLOLDUZLWKWKHRSHUDWLRQRIWKLVHTXLSPHQW$OO
SHUVRQQHOLQYROYHGZLWKWKHRSHUDWLRQRIWKHHTXLSPHQWPXVWXQGHUVWDQGSRWHQWLDOGDQJHUVRI
RSHUDWLRQ*HQHUDOVDIHJXDUGLQJWLSVDUHDVIROORZV
,PSURSHURSHUDWLRQFDQUHVXOWLQSHUVRQDOLQMXU\DQGRUGDPDJHWRWKHHTXLSPHQW2QO\
WUDLQHGSHUVRQQHOIDPLOLDUZLWKWKHRSHUDWLRQRIWKLVURERWWKHRSHUDWRU VPDQXDOVWKHV\VWHP
HTXLSPHQWDQGRSWLRQVDQGDFFHVVRULHVVKRXOGEHSHUPLWWHGWRRSHUDWHWKLVURERWV\VWHP
'RQRWHQWHUWKHURERWFHOOZKLOHLWLVLQDXWRPDWLFRSHUDWLRQ3URJUDPPHUVPXVWKDYHWKH
WHDFKSHQGDQWZKHQWKH\HQWHUWKHURERWFHOO
,PSURSHUFRQQHFWLRQVFDQGDPDJHWKHURERW$OOFRQQHFWLRQVPXVWEHPDGHZLWKLQWKH
VWDQGDUGYROWDJHDQGFXUUHQWUDWLQJVRIWKHURERW,2 ,QSXWVDQG2XWSXWV
7KHURERWPXVWEHSODFHGLQ(PHUJHQF\6WRS (6723 PRGHZKHQHYHULWLVQRWLQXVH
,QDFFRUGDQFHZLWK$16,5,$5VHFWLRQ6RXUFHVRI(QHUJ\XVH
ORFNRXWWDJRXWSURFHGXUHVGXULQJHTXLSPHQWPDLQWHQDQFH5HIHUDOVRWR6HFWLRQ
&)53DUW 2FFXSDWLRQDO6DIHW\DQG+HDOWK6WDQGDUGVIRU*HQHUDO,QGXVWU\
26+$
/GEJCPKECN5CHGV[&GXKEGU
7KHVDIHRSHUDWLRQRIWKHURERWSRVLWLRQHUDX[LOLDU\HTXLSPHQWDQGV\VWHPLVXOWLPDWHO\WKHXVHU V
UHVSRQVLELOLW\7KHFRQGLWLRQVXQGHUZKLFKWKHHTXLSPHQWZLOOEHRSHUDWHGVDIHO\VKRXOGEHUHYLHZHG
E\WKHXVHU7KHXVHUPXVWEHDZDUHRIWKHYDULRXVQDWLRQDOFRGHV$16,5,$5VDIHW\
VWDQGDUGVDQGRWKHUORFDOFRGHVWKDWPD\SHUWDLQWRWKHLQVWDOODWLRQDQGXVHRILQGXVWULDOHTXLSPHQW
$GGLWLRQDOVDIHW\PHDVXUHVIRUSHUVRQQHODQGHTXLSPHQWPD\EHUHTXLUHGGHSHQGLQJRQV\VWHP
LQVWDOODWLRQRSHUDWLRQDQGRUORFDWLRQ7KHIROORZLQJVDIHW\HTXLSPHQWLVSURYLGHGDVVWDQGDUG
6DIHW\IHQFHVDQGEDUULHUV
/LJKWFXUWDLQVDQGRUVDIHW\PDWV
'RRULQWHUORFNV
(PHUJHQF\VWRSSDOPEXWWRQVORFDWHGRQRSHUDWRUVWDWLRQURERWFRQWUROOHUDQG
SURJUDPPLQJSHQGDQW
&KHFNDOOVDIHW\HTXLSPHQWIUHTXHQWO\IRUSURSHURSHUDWLRQ5HSDLURUUHSODFHDQ\QRQIXQFWLRQLQJ
VDIHW\HTXLSPHQWLPPHGLDWHO\
(KPCN RCIG
(WPEVKQP/CPWCN
%JCRVGT 5CHGV[
+PUVCNNCVKQP5CHGV[
6DIHLQVWDOODWLRQLVHVVHQWLDOIRUSURWHFWLRQRISHRSOHDQGHTXLSPHQW7KHIROORZLQJVXJJHVWLRQVDUH
LQWHQGHGWRVXSSOHPHQWEXWQRWUHSODFHH[LVWLQJIHGHUDOORFDODQGVWDWHODZVDQGUHJXODWLRQV
$GGLWLRQDOVDIHW\PHDVXUHVIRUSHUVRQQHODQGHTXLSPHQWPD\EHUHTXLUHGGHSHQGLQJRQV\VWHP
LQVWDOODWLRQRSHUDWLRQDQGRUORFDWLRQ,QVWDOODWLRQWLSVDUHDVIROORZV
%HVXUHWKDWRQO\TXDOLILHGSHUVRQQHOIDPLOLDUZLWKQDWLRQDOFRGHVORFDOFRGHVDQG
$16,5,$5VDIHW\VWDQGDUGVDUHSHUPLWWHGWRLQVWDOOWKHHTXLSPHQW
,GHQWLI\WKHZRUNHQYHORSHRIHDFKURERWZLWKIORRUPDUNLQJVVLJQVDQGEDUULHUV
3RVLWLRQDOOFRQWUROOHUVRXWVLGHWKHURERWZRUNHQYHORSH
:KHQHYHUSRVVLEOHLQVWDOOVDIHW\IHQFHVWRSURWHFWDJDLQVWXQDXWKRUL]HGHQWU\LQWRWKHZRUN
HQYHORSH
(OLPLQDWHDUHDVZKHUHSHUVRQQHOPLJKWJHWWUDSSHGEHWZHHQDPRYLQJURERWDQGRWKHU
HTXLSPHQW SLQFKSRLQWV
3URYLGHVXIILFLHQWURRPLQVLGHWKHZRUNFHOOWRSHUPLWVDIHWHDFKLQJDQGPDLQWHQDQFH
SURFHGXUHV
2TQITCOOKPI1RGTCVKQPCPF/CKPVGPCPEG5CHGV[
$OORSHUDWRUVSURJUDPPHUVSODQWDQGWRROLQJHQJLQHHUVPDLQWHQDQFHSHUVRQQHOVXSHUYLVRUVDQG
DQ\RQHZRUNLQJQHDUWKHURERWPXVWEHFRPHIDPLOLDUZLWKWKHRSHUDWLRQRIWKLVHTXLSPHQW,PSURSHU
RSHUDWLRQFDQUHVXOWLQSHUVRQDOLQMXU\DQGRUGDPDJHWRWKHHTXLSPHQW2QO\WUDLQHGSHUVRQQHO
IDPLOLDUZLWKWKHRSHUDWLRQPDQXDOVHOHFWULFDOGHVLJQDQGHTXLSPHQWLQWHUFRQQHFWLRQVRIWKLVURERW
VKRXOGEHSHUPLWWHGWRSURJUDPRSHUDWHDQGPDLQWDLQWKHV\VWHP$OOSHUVRQQHOLQYROYHGZLWKWKH
RSHUDWLRQRIWKHHTXLSPHQWPXVWXQGHUVWDQGSRWHQWLDOGDQJHUVRIRSHUDWLRQ
,QVSHFWWKHURERWDQGZRUNHQYHORSHWREHVXUHQRSRWHQWLDOO\KD]DUGRXVFRQGLWLRQVH[LVW%H
VXUHWKHDUHDLVFOHDQDQGIUHHRIZDWHURLOGHEULVHWF
%HVXUHWKDWDOOVDIHJXDUGVDUHLQSODFH&KHFNDOOVDIHW\HTXLSPHQWIRUSURSHURSHUDWLRQ
5HSDLURUUHSODFHDQ\QRQIXQFWLRQLQJVDIHW\HTXLSPHQWLPPHGLDWHO\
'RQRWHQWHUWKHURERWFHOOZKLOHLWLVLQDXWRPDWLFRSHUDWLRQ%HVXUHWKDWRQO\WKHSHUVRQ
KROGLQJWKHSURJUDPPLQJSHQGDQWHQWHUVWKHZRUNFHOO
&KHFNWKH(6723EXWWRQRQWKHSURJUDPPLQJSHQGDQWIRUSURSHURSHUDWLRQEHIRUH
SURJUDPPLQJ7KHURERWPXVWEHSODFHGLQ(PHUJHQF\6WRS (6723 PRGHZKHQHYHULWLV
QRWLQXVH
%DFNXSDOOSURJUDPVDQGMREVRQWRVXLWDEOHPHGLDEHIRUHSURJUDPFKDQJHVDUHPDGH7R
DYRLGORVVRILQIRUPDWLRQSURJUDPVRUMREVDEDFNXSPXVWDOZD\VEHPDGHEHIRUHDQ\
VHUYLFHSURFHGXUHVDUHGRQHDQGEHIRUHDQ\FKDQJHVDUHPDGHWRRSWLRQVDFFHVVRULHVRU
HTXLSPHQW
RCIG (KPCN
5GTXQ(NQCV
$Q\PRGLILFDWLRQVWR3$576\VWHP6HFWLRQRIWKHURERWFRQWUROOHUFRQFXUUHQW,2
SURJUDPFDQFDXVHVHYHUHSHUVRQDOLQMXU\RUGHDWKDVZHOODVGDPDJHWRWKHURERW'RQRW
PDNHDQ\PRGLILFDWLRQVWR3$576\VWHP6HFWLRQ0DNLQJDQ\FKDQJHVZLWKRXWWKHZULWWHQ
SHUPLVVLRQRI0RWRPDQZLOO92,'<285:$55$17<
6RPHRSHUDWLRQVUHTXLUHVWDQGDUGSDVVZRUGVDQGVRPHUHTXLUHVSHFLDOSDVVZRUGV6SHFLDO
SDVVZRUGVDUHIRU0RWRPDQXVHRQO\<285:$55$17<:,//%(92,'LI\RXXVH
WKHVHVSHFLDOSDVVZRUGV
7KHURERWFRQWUROOHUDOORZVPRGLILFDWLRQVRI3$578VHU6HFWLRQRIWKHFRQFXUUHQW,2
SURJUDPDQGPRGLILFDWLRQVWRFRQWUROOHUSDUDPHWHUVIRUPD[LPXPURERWSHUIRUPDQFH*UHDW
FDUHPXVWEHWDNHQZKHQPDNLQJWKHVHPRGLILFDWLRQV$OOPRGLILFDWLRQVPDGHWRWKH
FRQWUROOHUZLOOFKDQJHWKHZD\WKHURERWRSHUDWHVDQGFDQFDXVHVHYHUHSHUVRQDOLQMXU\RU
GHDWKDVZHOODVGDPDJHWKHURERWDQGRWKHUSDUWVRIWKHV\VWHP'RXEOHFKHFNDOO
PRGLILFDWLRQVXQGHUHYHU\PRGHRIURERWRSHUDWLRQWRHQVXUHWKDW\RXKDYHQRWFUHDWHG
KD]DUGVRUGDQJHURXVVLWXDWLRQV
&KHFNDQGWHVWDQ\QHZRUPRGLILHGSURJUDPDWORZVSHHGIRUDWOHDVWRQHIXOOF\FOH
7KLVHTXLSPHQWKDVPXOWLSOHVRXUFHVRIHOHFWULFDOVXSSO\(OHFWULFDOLQWHUFRQQHFWLRQVDUH
PDGHEHWZHHQWKHFRQWUROOHUDQGRWKHUHTXLSPHQW'LVFRQQHFWDQGORFNRXWWDJRXWDOO
HOHFWULFDOFLUFXLWVEHIRUHPDNLQJDQ\PRGLILFDWLRQVRUFRQQHFWLRQV
'RQRWSHUIRUPDQ\PDLQWHQDQFHSURFHGXUHVEHIRUHUHDGLQJDQGXQGHUVWDQGLQJWKHSURSHU
SURFHGXUHVLQWKHDSSURSULDWHPDQXDO
8VHSURSHUUHSODFHPHQWSDUWV
,PSURSHUFRQQHFWLRQVFDQGDPDJHWKHURERW$OOFRQQHFWLRQVPXVWEHPDGHZLWKLQWKH
VWDQGDUGYROWDJHDQGFXUUHQWUDWLQJVRIWKHURERW,2 ,QSXWVDQG2XWSXWV
(KPCN RCIG
(WPEVKQP/CPWCN
%JCRVGT 5CHGV[
016'5
RCIG (KPCN
YASKAWA
NX100 OPTIONS
INSTRUCTIONS
FOR SERVOFLOAT FUNCTION
Upon receipt of the product and prior to initial operation, read these instructions thoroughly, and retain
for future reference.
MOTOMAN INSTRUCTIONS
MOTOMAN- INSTRUCTIONS
NX100 INSTRUCTIONS
NX100 OPERATOR’S MANUAL
NX100 MAINTENANCE MANUAL
The NX100 operator’s manuals above correspond to specific usage.
Be sure to use the appropriate manual.
MANDATORY
• This manual explains the servofloat function of the NX100 system and
general operations. Read this manual carefully and be sure to under-
stand its contents before handling the NX100.
CAUTION
• Some drawings in this manual are shown with the protective covers or
shields removed for clarity. Be sure all covers and shields are replaced
before operating this product.
• YASKAWA may modify this model without notice when necessary due to
product improvements, modifications, or changes in specifications. If
such modification is made, the manual number will also be revised.
ii
HW0482018
Even items described as “CAUTION” may result in a serious accident in some situations. At
any rate, be sure to follow these important items.
NOTE To ensure safe and efficient operation at all times, be sure to follow all instructions, even if
not designated as “CAUTION” and “WARNING”.
iii
HW0482018
WARNING
• Before operating the manipulator, check that servo power is turned OFF
when the emergency stop buttons on the front door of the NX100 and
programming pendant are pressed.
When the servo power is turned OFF, the SERVO ON LED on the program-
ming pendant is turned OFF.
Injury or damage to machinery may result if the emergency stop circuit cannot stop the
manipulator during an emergency. The manipulator should not be used if the emergency
stop buttons do not function.
• Once the emergency stop button is released, clear the cell of all items
which could interfere with the operation of the manipulator. Then turn
the servo power ON.
Injury may result if anyone enters the P-point maximum envelope of the manipulator dur-
ing operation. Always press an emergency stop button immediately if there is a problem.
The emergency stop buttons are located on the right of the front door of the NX100 and
the programming pendant.
iv
HW0482018
CAUTION
• Perform the following inspection procedures prior to conducting manip-
ulator teaching. If problems are found, repair them immediately, and be
sure that all other necessary processing has been performed.
-Check for problems in manipulator movement.
-Check for damage to insulation and sheathing of external wires.
• Always return the programming pendant to the hook on the NX100 cabi-
net after use.
The programming pendant can be damaged if it is left in the manipulator’s work area, on
the floor, or near fixtures.
v
HW0482018
Descriptions of the programming pendant keys, buttons, and displays are shown as follows:
Programming Character Keys The keys which have characters printed on them are
Pendant denoted with [ ].
ex. [ENTER]
Symbol Keys The keys which have a symbol printed on them are
not denoted with [ ] but depicted with a small picture.
GO BACK
Axis Keys “Axis Keys” and “Numeric Keys” are generic names
Numeric Keys for the keys for axis operation and number input.
vi
HW0482018
1 Servofloat Function
1.1 Link Servofloat Function . . . . . . . . . . . . . . . . . . . . . . . . . . . .1-1
1.2 Linear Servofloat Function . . . . . . . . . . . . . . . . . . . . . . . . . .1-2
1.3 Using the Link Servofloat Function and the Linear
Servofloat Function . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .1-2
5 Registration of Instruction
5.1 FLOATON Instruction. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .5-1
5.2 FLOATOF Instruction . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .5-3
5.3 Addition of SPDL Tag to a Move Instruction . . . . . . . . .5-3
vii
HW0482018
viii
HW0482018
1.1 Link Servofloat Function
1 Servofloat Function
The servofloat function of the NX100 consists of the link servofloat function and the linear ser-
vofloat function. The link servofloat function controls the torque independently for each axis;
and the linear servofloat function controls the torque on the Cartesian coordinates. Select
these two functions by setting the servofloat instructions accordingly.
The link servofloat function works in combination with the position control and the torque con-
trol, whereas an ordinary control is a position control that generates torque to keep the taught
position regardless of the applied external force. “Torque control” keeps the taught position
only by using the torque against the gravitational and frictional forces. Therefore, a manipula-
tor moved by an external force will not return to its original position.
With the servofloat function, external force moves the manipulator since the torque control has
priority over the position control.
For example, when removing a workpiece from the die-casting machine, a large external force
is applied to the manipulator by the extruding cylinder when a workpiece is grasped and pulled
out. The servofloat function is used to protect the manipulator from excessive external force,
and the manipulator moves according to the force applied from the die-casting machine.
Note that the manipulator does not move exactly to the taught position or along the taught
path, because complete position control is not performed during execution of the servofloat
function.
1-1
HW0482018
*1 When external force is applied, the R, B, and T-axes move the same as in the link
servo-float function.
Only the end of the U-axis moves in a linear motion.
Use the link servofloat function when high-ferquency noise, motor vibration, or unsteady
manipulator motion occur depending on the manipulator posture, speed, and movement direc-
tion.
1-2
HW0482018
Enable the servofloat function with the servofloat function start instruction FLOATON. It
remains enabled until one of the following conditions is established.
When the function is enabled, the manipulator generates only the torque that is less that the
value set to the servofloat condition file. The manipulator uses the torque to operate and keep
the position. If a large external force is applied, the manipulator moves according to this force.
2-1
HW0482018
If an external force prevents manipulator operation, the manipulator does not reach the taught
position when the servofloat function is enabled. Even though the manipulator does not actu-
ally reach the taught position, the instruction that would be activated at that position are none-
theless enabled, so the move instruction terminated.
Therefore, when the manipulator cannot reach the taught position because of an external
force, the manipulator performs the next instruction.
The following figure shows an example where the operation time is 5 seconds from STEP 1 to
STEP 2. If the manipulator hits an obstruction 3 seconds after STEP 1 and stops there, it
remains stopped at the position for the remaining 2 seconds, and then moves to STEP 3 with-
out moving to STEP 2 when moving with the torque control.
5 seconds
STEP 1 MOVL V=100.0
3 seconds FLOATON FL#(1)
Obstruction STEP 2 MOVL V=100.0
STEP 3 MOVL V=100.0
FLOATOF
STEP 2
STEP 1
STEP 3
2-2
HW0482018
2.2 Moving with the TIMER and WAIT Instructions
When the servofloat function is enabled, torque control can be performed even during the
TIMER and WAIT instructions. These instructions end when time is up or when a condition
described in page 2-1 is established.
For example, in the following figure, the manipulator reaches STEP 1, and the FLOATON
instruction enables the servofloat function. Then the manipulator waits for the input of IN#1 by
the WAIT instruction. In this state, if an external force is applied to the manipulator, the manip-
ulator moves to the point P and stops. If the FLOATOF instruction is performed at this point,
the servofloat function is disabled and the manipulator moves from point P to STEP 2.
Application of
external force STEP 1 MOVL V=100.0
FLOATON FL#(1)
STEP 1 Taught path
STEP 2 WAIT IN#(1)=ON
FLOATOF
Movement by
STEP 2 MOVL V=100.0
external force
Actual path
Point P
When the servofloat function is enabled, the soft limit, cube interference, and the S-axis inter-
ference are checked at the actual position of the manipulator even though external force
moved the manipulator.
If an alarm occurs when the servofloat function is enabled, the servofloat function may remain
effective depending on the type of alarm. To disable the servofloat during an alarm, enter
“external emergency stop” or “servo OFF signal” during the “alarm occurrence” signal output.
This turns OFF the servo power supply and applies the brakes.
2-3
HW0482018
When the servofloat function is enabled, the message “Servo float activated” appears at the
bottom of the programming pendant display, and the specific output 50274 “SERVOFLOAT
ON R1” is output.
When the servo power has been turned OFF due to an emergency stop during servofloat
operation and turns ON again, press the [SERVO ON READY] on the playback panel until
this servo recognizes that the power supply is turned ON. If the button is not pressed for a
long enough time, the message “depress servo power ON” appears and the servo power can-
not be turned ON.
2-4
HW0482018
CAUTION
• If the values for the maximum force and maximum torque are set too
low, gravity may cause an arm to drop.
There are two kinds of servofloat condition files: the link servofloat condition file specified for
the link servofloat function, and the linear servofloat condition file specified for the linear ser-
vofloat function.
3-1
HW0482018
Operation Explanation
LINK SERVOFLOAT
COND NO. : 1 / 8
FUNC +MAX.TORQUE(%) -MAX.TORQUE(%)
R1 : S 30 -30
L 40 -40
50
c U
R 100
-50
-100
B 100 -100
T 100 -100
MRESET PAGE
cFUNC
Enables/Disables the link servofloat function for each axis.
“z” indicates that the function is enabled; “{” indicates that the
function is disabled.
Pressing [SELECT] switches between “z” and “{”.
d(+) MAX. TORQUE / (-) MAX. TORQUE
Limits the amount of torque generated for keeping control of the
position of each axis.
Set the value for each axis using the ratios (%) of the positive and
negative sides of the motor to the motor rated torque. The
smaller the value is set, the more easily the manipulator can be
moved by an external force.
3 Select an item to be set, The display enters the number input status. Enter a value for
and set the value “MAX. TORQUE” by pressing the numeric keys. Then, press
[ENTER].
3-2
HW0482018
3.2 Linear Servofloat Condition File
Operation Explanation
LINEAR SERVOFLOAT
COND NO. : 1 / 8
c COORDINATE ROBOT
TOOL ORIENT'N OFF
FUNC +MAX.FORCE -MAX.FORCE
R1 : X 30 kgf -30 kgf
d Y
Z
40 kgf
50 kgf
-40 kgf
-50 kgf
e
FUNC +MAX.TORQUE -MAX.TORQUE
R1 : R 30 % -30 %
B 40 % -40 %
T 50 % -50 %
f
MRESET PAGE
cCOORDINATE
Sets a coordinate system for the linear servofloat function.
Select the ROBOT coordinates, BASE coordinates, USER coordi-
nates or TOOL coordinates.
The selection dialog box appears by pressing [SELECT]. Select
a coordinate system to be set.
dFUNC
Enables/Disables the linear servofloat function for each axis.
“z” indicates that the function is enabled; “{” indicates that the
function is disabled.
Pressing [SELECT] switches between “z” and “{”.
e(+) MAX. FORCE / (-) MAX. FORCE
Limits the amount of force generated for keeping control of the
position of each axis.
When the linear servofloat is enabled, a force bigger than this set
value is not generated. The smaller the value is set, the more
easily a set coordinate axis can be moved by an external force.
However, if the set value is less than the manipulator friction, the
manipulator may not move.
f(+) MAX. TORQUE / (-) MAX. TORQUE
Limits the amount of torque generated for keeping control of the
position of R-, B-, and T-axes.
Set the value for each axis using the ratios (%) of the positive and
negative sides of the motor to the motor rated torque. The
smaller the value is set, the more easily an axis can be moved by
an external force.
3 Select an item to be set, The display enters the number input status. Enter a value for
and set the value “MAX. TORQUE” by pressing the numeric keys. Then, press
[ENTER].
3-3
HW0482018
4.1 FLOATON Instruction
FLOATON is an instruction to enable and start the link servofloat function or the linear servof-
loat function.
Additional items for the FLOATON instruction are as follows:
FLOATON
c FL#(1 to 8)
d LFL#(1 to 8)
FLOATOF is an instruction to disable and end the link servofloat function or the linear servof-
loat function. The servofloat function can be also disabled by performing servo OFF.
The SPDL tag is a stop confirmation tag with which a motion is completed when the number of
speed feedback pulses of all the axes becomes less than a constant value.
Use an SPDL tag to confirm the end of a motion caused by an external force. Add it to the
move instruction immediately before the FLOATOF instruction.
If the move instruction is completed with a SPDL tag added, the next instruction will not be
performed as long as the manipulator is being moved by an external force.
4-1
HW0482018
5.1 FLOATON Instruction
5 Registration of Instruction
When in the job content display in teach mode, register an instruction with the cursor in the
address area.
Operation Explanation
JOB CONTENT
JOB NAME : TEST STEP NO : 003
CONTROL GROUP : R1 TOOL : 00
0000 NOP
0001 'TEST JOB
Address 0002 MOVJ VJ=50.00 Instruction
0003 MOVJ VJ=12.50
area 0004 MOVL V=276
area
0005 TIMER T=1.00
0006 DOUT OT#(1) ON
Operation Explanation
CONTROL
DEVICE
MOTION
ARITH
SHIFT
FLOATON OTHER
FLOATOF SAME
PRIOR
5-1
HW0482018
Operation Explanation
3 Select “FLOATON” The “FLOATON” instruction appears in the input buffer line.
=> FLOATON
DETAIL EDIT
FLOATON
SV FLOAT FILE UNUSED
=> FLOATON
With the cursor on “UNUSED” for the “SV FLOAT FILE”, press
[SELECT]. The selection dialog box appears with the choices
“FL# ( )” or “LFL# ( )”. Select one.
DETAIL EDIT
FLOATON
SV FLOAT FILE FL#( ) 1
5 Press [INSERT] and The instruction displayed in the input buffer line is registered.
[ENTER]
5-2
HW0482018
5.2 FLOATOF Instruction
Operation Explanation
CONTROL
DEVICE
MOTION
ARITH
SHIFT
FLOATON OTHER
FLOATOF SAME
PRIOR
3 Select “FLOATOF” The “FLOATOF” instruction appears in the input buffer line.
=> FLOATOF
5 Press [INSERT] and The instruction displayed in the input buffer line is registered.
[ENTER]
When in the job content display in teach mode, add an SPDL tag to a move instruction, with
the cursor in the instruction area.
Operation Explanation
1 Select the line of the move The move instruction appears in the input buffer line.
instruction where the SPDL
tag is to be added => MOVJ VJ=50.00
5-3
HW0482018
Operation Explanation
DETAIL EDIT
MOVJ
JOINT SPEED VJ= 50.00
POS LEVEL UNUSED
NWAIT UNUSED
DETAIL EDIT
MOVJ
JOINT SPEED VJ= 50.00
POS LEVEL SPDL= 0
NWAIT UNUSED
3 Press [INSERT] and The instruction displayed in the input buffer line is registered.
[ENTER]
5-4
HW0482018
6.1 Movement Example
When removing a workpiece from a die-casting machine, a large external force is applied to
the manipulator during extraction after grasping it. In such a case, the following example is
applicable using the servofloat function.
Biscuit
Tool
6-1
HW0482018
2. Moves to the grasping starting point and performs the TIMER instruction, and then
starts the servofloat function.
3. When function enabled, the manipulator grasps a “biscuit”.
4. After having grasped a workpiece, the “start extraction instruction” signal is output, and
the manipulator performs an extracting motion.
5. The “start extraction instruction” signal starts the extraction operation of the die-casting
machine. Thereby, the manipulator performs an extracting motion.
6. The die-casting machine outputs the “end extraction instruction” signal when the
manipulator reaches the completion position. The manipulator ends the servofloat
function.
Extruding
6-2
HW0482018
6.1 Movement Example
7. The manipulator returns to its normal motion and performs an extraction motion with
the workpiece. Then, it returns to the home position.
6-3
HW0482018
Performs the extraction motion. Ends the motion MOVL V=50.0 UNTIL IN#(11)
when the “end extraction instruction” signal (gen-
5 eral input No. 11) is input during the motion.
6-4
HW0482018
6.3 A Setting Example in the Linear Servofloat Condition File
For the example described in “6.1 Movement Example”, set the servofloat condition file as fol-
lows.
In the example, the extracting direction corresponds to that of the Y-axis of the robot coordi-
nates. If the direction does not correspond to the robot coordinates, define the extracting
direction with the user coordinates and set “COORDINATE” to “USER#01”.
LINEAR SERVOFLOAT
COND NO. : 1 / 8
COORDINATE USER#01
TOOL ORIENT'N OFF
FUNC +MAX.FORCE -MAX.FORCE
R1 : X 100 kgf -100 kgf
Y 0 kgf -0 kgf
Z 100 kgf -100 kgf
FUNC +MAX.TORQUE -MAX.TORQUE
R1 : R 100 % -100 %
B 100 % -100 %
T 100 % -100 %
MRESET PAGE
6-5
HW0482018
For the example described in “6.1 Movement Example”, specify the link servofloat condition
file by specifying LF# as the FLOATON instruction file. In this case, a setting example is as
follows.
Since the S-axis moves according to the force applied by the extruding cylinder of the die-
casting machine, set the “MAX. TORQUEs” of the S-axis to “0”. Set the “MAX. TORQUEs” of
the L- and U-axes to “30” to prevent the arms from dropping or rising up due to the load varia-
tion. To orientate the tool posture, set the “MAX. TORQUEs” of the R-, B-, and T-axes to
“100”.
Using the above settings as a guide, adjust the ratio of each set value according to the circum-
stances.
LINK SERVOFLOAT
COND NO. : 1 / 8
FUNC +MAX.TORQUE(%) -MAX.TORQUE(%)
R1 : S 0 0
L 30 -30
U 30 -30
R 100 -100
B 100 -100
T 100 -100
MRESET PAGE
6-6
NX100 OPTIONS
INSTRUCTIONS
FOR SERVOFLOAT FUNCTION
HEAD OFFICE
2-1 Kurosaki-Shiroishi, Yahatanishi-ku, Kitakyusyu-shi, 806-0004, Japan
Phone 81-93-645-7745 Fax 81-93-645-7746
MOTOMAN INC. HEADQUARTERS
805 Liberty Lane West Carrollton, OH 45449, U.S.A.
Phone 1-937-847-6200 Fax 1-937-847-6277
YASKAWA MOTOMAN CANADA LTD.
2280 Argentia Road, Mississauga, Ontario, L5N 6H8, Canada
Phone 1-905-813-5900 Fax 1-905-813-5911
YASKAWA ELECTRIC AMERICA, INC.
2121 Norman Drive South Waukegan, IL 60085, U.S.A.
Phone 1-847-887-7000 Fax 1-847-887-7370
YASKAWA ELECTRIC EUROPE GmbH
Am Kronberger Hang 2, 65824 Schwalbach,Germany
Phone 49-6196-569-300 Fax 49-6196-888-301
MOTOMAN ROBOTICS EUROPE AB
Box 504 S38525 Torsas, Sweden
Phone 46-486-48800 Fax 46-486-41410
MOTOMAN ROBOTEC GmbH
Kammerfeldstr.1,D-85391 Allershausen, Germany
Phone 49-8166-90100 Fax 49-8166-90103
YASKAWA ELECTRIC KOREA CORPORATION
KFPA Bldg #1201, 35-4 Yeoido-dong, Youngdungpo-Ku, Seoul 150-010, Korea
Phone 82-2-784-7844 Fax 82-2-784-8495
YASKAWA ELECTRIC (SINGAPORE) PTE. LTD.
151 Lorong Chuan, #04-01, New Tech Park Singapore 556741, Singapore
Phone 65-6282-3003 Fax 65-6289-3003
YASKAWA ELECTRIC (SINGAPORE) PTE. LTD. MALAYSIA REPRESENTATIVE OFFICE
B615, 6th Floor, East Wing, Wisma Tractors, No.7, Jalan SS 16/1, Subang Jaya, 47500 Petaling Jaya, Selangor D.E. Malaysia
Phone 60-3-5031-5311 Fax 60-3-5031-5312
YASKAWA ELECTRIC (SHANGHAI) CO., LTD.
4F No Aona Road, Waigaoqiao Free Trade Zone, Pudong New Area, Shanghai 200131, China
Phone 86-21-5866-3470 Fax 86-21-5866-3869
YASKAWA ELECTRIC TAIWAN CORPORATION
9F, 16, Nanking E. RD., Sec. 3, Taipei, Taiwan
Phone 886-2-2502-5003 Fax 886-2-2505-1280
YASKAWA ELECTRIC (HK) COMPANY LIMITED
Rm. 2909-10, Hong Kong Plaza, 186-191 Connaught Road West, Hong Kong
Phone 852-2803-2385 Fax 852-2547-5773
BEIJING OFFICE
Room No. 301 Office Building Intemational Club, 21 Jianguomenwai Avenue, Beijing 100020, China
Phone 86-10-6532-1850 Fax 86-10-6532-1851
BEIJING YASKAWA BEIKE AUTOMATION ENGINEERING CO.,LTD.
30 Xue Yuan Road, Haidian, Beijing P.R. China Post Code: 100083, China
Phone 86-10-6234-5003 Fax 86-10-6234-5002
SHOUGANG MOTOMAN ROBOT CO., LTD.
7,Yongchang-North Road, Beijing Economic & Technological Development Area, Beijing 100076, China
Phone 86-10-6788-0541 Fax 86-10-6788-2878
YASKAWA