
-ii-
(4) Specifying the force control mode (P_FsMod0/P_FsMod1, FSFMD0#) ......................................................... 55
(5) Specifying the stiffness coefficient (P_FsStf0/P_FsStf1, FSSTF0#) ................................................................. 58
(6) Specifying the damping coefficient (P_FsDmp0/P_FsDmp, FSDMP0#) ........................................................... 61
(7) Specifying the force command value and limit value (P_FsFCd0/P_FsFCd, FSFCMD0#) ............................... 62
(8) Specifying the force sense control gain (P_FsGn0/P_FsGn1, FSSWF0#)........................................................ 63
(9) Specifying the speed command value (P_FsSpd0/P_FsSpd1, FSSPD0#) ....................................................... 67
(10) Specifying the mode switching judgment value (P_FsSwf0/P_FsSwf1, FSSWF0#) ....................................... 68
(11) Specifying the force detection setting value (P_FsFLm0/P_FsFLm1, FSFLMT0#) ......................................... 71
(12) Offset cancel designation ................................................................................................................................ 72
(13) Gravity Offset Cancel Function ....................................................................................................................... 75
Chapter 6 Force Log ...................................................................................................................................................... 85
6.1 Force Log Parameters......................................................................................................................................... 85
6.2 Force Log Data Acquisition (FsLog On/FsLog Off).............................................................................................. 86
Practice 7: Force log ........................................................................................................................................... 87
6.3 Force Sense Log Data Display (RT ToolBox3).................................................................................................... 89
(1) Start Method...................................................................................................................................................... 89
(2) Main Window..................................................................................................................................................... 89
6.4 Force Log File FTP Transfer ............................................................................................................................... 90
6.5 Oscillograph (RT ToolBox3) ................................................................................................................................ 91
Chapter 7 Teaching Operation ....................................................................................................................................... 93
7.1 Teaching Position Precautions ............................................................................................................................ 93
7.2 Teaching Position Search.................................................................................................................................... 94
7.3 Precautions when using stiffness control............................................................................................................. 96
7.4 Practice ............................................................................................................................................................... 97
Practice 8: Teaching the force sense .................................................................................................................. 97
Practice 9 Teaching the insert complete position with the force sensor (using the force control) ......................101
Practice 10 Teaching the insert complete position with the force sensor (using the stiffness control) ...............102
Chapter 8 Force Sense Function (Interrupt Processing) ...............................................................................................103
8.1 Control mode/Control characteristics .................................................................................................................103
(1) Control characteristics Change Commands (FsGChg/FsCTrg) .......................................................................103
8.2 Practice ..............................................................................................................................................................105
Practice 11: Changing the control characteristics ..............................................................................................105
Practice 12: Changing the control characteristics ..............................................................................................109
Chapter 9 Force Sense Detection .................................................................................................................................113
9.1 Force Sense Detection .......................................................................................................................................113
9.2 Mo Trigger (DefMoTrg, SetMoTrg, M_MoTrg) ...................................................................................................114
9.3 Force Detection Status (M_FsLmtS, P_FsLmtR) ...............................................................................................115
9.4 Data Latch (P_FsLmtX/P_FsLmtP/P_FsLmtD) ..................................................................................................116
9.5 Data Verification (P_FsMaxD / P_FsCurD) ........................................................................................................117
9.6 Practice ..............................................................................................................................................................119
Practice 13: Interrupt processing .......................................................................................................................119
Chapter10 Exercise.......................................................................................................................................................123
Exercise 1: Phase focusing and assembly inspection ..............................................................................................123
Exercise 1-1 Hand insertion and withdraw operation .........................................................................................123
Exercise 1-2 Perform phase focusing for the gear at hand insertion, and pulling out operation.........................127
Exercise 1-3 Hand insertion (phase focusing), gear rotation confirmation, pulling out operation ....................133
Exercise 2 : Following operation...............................................................................................................................139
Exercise 2-1 Follow the curved surface .............................................................................................................139
Exercise 2-2 Move by following the curved surface ...........................................................................................143
Exercise 3: Interrupt processing, data latch .............................................................................................................149
Exercise 3: Interrupt processing, data latch .......................................................................................................149
Appendix 1 Connecting the Force Sensor.....................................................................................................................153
Appendix 1.1 Connecting the Force Sensor and the Force Sense Interface Unit.....................................................153
(1) Robot with internal wiring (-SH**).....................................................................................................................153
(2) Standard robot + option (forearm external wiring set) ......................................................................................153
(3) Standard robot + external wiring (external routing) ..........................................................................................154
Appendix 2 Coordinate System Definition.....................................................................................................................155
Appendix 2.1 Force Sense Coordinate System (Mechanical Interface) ...................................................................155
Appendix 2.2 Force Sense Coordinate System (Tool) .............................................................................................156
Appendix 2.3 Force Sense Coordinate System (XYZ) .............................................................................................156
Appendix 3 Contact Detection.......................................................................................................................................157
(1) Using the contact detection.................................................................................................................................157
(2) Displaying the force detection setting value in the teaching box .........................................................................158
(3) Usage example (contact detection/force sense monitor) ....................................................................................159
Appendix 4 Operation of the Teaching Box (R56TB) ....................................................................................................161
Appendix 4.1 Editing Parameter...............................................................................................................................161