Remote wire connection system, controller, remote wire connection method and program

The remote connection system addresses safety concerns in blasting operations by allowing precise remote control of detonator leg wire connections, ensuring worker safety and reliable electrical connections through force-tactile sensation transmission.

JP2024160844APending Publication Date: 2024-11-15OHBAYASHI GUMI LTD +1
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2023076279
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-02
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

Existing blasting methods in tunnel excavation require manual connection of electric detonator leg wires, posing safety risks due to skin-dropping hazards and the need for precise operations, which are not adequately addressed by remote control systems.

Method used

A remote connection system utilizing a wiring mechanism, moving mechanism, operating mechanism, and reaction force applying means to perform electrical connections safely by transmitting force-tactile sensations, allowing workers to control the connection process remotely without direct proximity to the charging holes.

Benefits of technology

Ensures worker safety by enabling precise electrical connections through remote control, avoiding skin-dropping hazards and ensuring reliable connection of detonator leg wires, applicable to various environments where electrical connections are challenging.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024160844000001_ABST
    Figure 2024160844000001_ABST
Patent Text Reader

Abstract

To enables electrical wire connections to be made more appropriately while ensuring safety of operators.SOLUTION: A remote wire connection system 1 comprises a wire connection device 20, an operation device 10, and a controller 30. The wire connection device 20 comprises a wire connection mechanism 26 for connecting a plurality of linear members (such as a leg wire W) and a movement mechanism 25 for moving the wire connection mechanism 26. The operation device 10 comprises a first operation mechanism 15 and a second operation mechanism 16 that accept remote control for the wire connection device 20, and an actuator 12a that exerts a reaction force against the remote control input to the first operation mechanism 15. The controller 30 comprises an operation control unit 312 that controls operation of the movement mechanism 25 according to the remote control input to the first operation mechanism 15 for the movement mechanism 25, and controls operation of the actuator 12a to exert the reaction force according to the force applied to the movement mechanism 25.SELECTED DRAWING: Figure 6
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a remote wiring system, a control device, a remote wiring method, and a program. [Background technology]

[0002] Conventionally, blasting methods using explosives have been widely used in tunnel excavation work. In blasting methods, explosives such as water-containing explosives (slurry explosives) and ammonium nitrate oil explosives (anphos explosives) and other explosives, as well as fillers for blocking the openings of the charge holes, are loaded manually using a tool called a loading rod. In addition, explosives with electric detonators (parent die) and, as necessary, additional explosives without electric detonators (additional die) are used as explosives. An ignition lead (leg wire) is drawn from the explosives with electric detonators, and the leg wires of multiple electric detonators are connected in series by workers. When loading explosives manually in this way, it is necessary to work close to the face. However, there is a risk of soil or rocks peeling off or falling off at the face due to natural or human factors, so-called "skin fall." Therefore, excavation work using the blasting method can be dangerous for workers. Therefore, attempts have been made to realize blasting preparation work by remote control. For example, Patent Document 1 describes a technology that uses a robot arm to perform loading work without an operator approaching the face. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2020-003145 A Summary of the Invention [Problem to be solved by the invention]

[0004] However, even if the explosive loading operation is performed remotely by a robot arm, when an explosive with an electric detonator is used, the leg wire of the electric detonator needs to be connected. In this case, the worker must approach the face in order to connect the leg wires of the electric detonator, and the connection work is accompanied by the risk of the skin falling off. In addition, when connecting the leg wires of an electric detonator, the insulation of the leg wires is stripped off and the exposed metal parts are twisted so that they are in contact with each other. Therefore, if this work is not done properly, it can lead to blasting failure, so it is necessary to do the work with high precision. Such problems are common not only to the connection of leg wires in blasting, but also to various other situations in which electrical connections are made.

[0005] An object of the present invention is to more appropriately perform electrical connections while ensuring the safety of workers. [Means for solving the problem]

[0006] In order to solve the above problems, a remote wiring system according to an embodiment of the present invention comprises: a connection mechanism for connecting a plurality of linear members; a moving mechanism for moving the wire connection mechanism; A wire connection device comprising: an operation mechanism for receiving a remote operation of the wire connection device; A reaction force applying means for applying a reaction force to a remote operation input to the operation mechanism; An operating device comprising: an operation control means for controlling an operation of the moving mechanism in response to a remote operation of the moving mechanism input to the operation mechanism, and for controlling an operation of the reaction force application means to apply a reaction force in response to a force applied to the moving mechanism; The present invention is characterized by comprising: Effect of the Invention

[0007] According to the present invention, electrical connections can be more appropriately performed while ensuring the safety of workers. [Brief description of the drawings]

[0008] [Figure 1] 1 is a schematic diagram showing an overall configuration of a remote wiring system 1 according to an embodiment of the present invention. [Diagram 2] 2 is a block diagram showing the hardware configuration of an operation device 10 and a wiring device 20. FIG. [Diagram 3] 2 is a schematic diagram (perspective view) showing the external configuration of a wire connection mechanism 26. FIG. [Figure 4] FIG. 2 is a schematic diagram showing a top view of the wire connection mechanism 26. [Diagram 5] 3A to 3C are schematic diagrams showing a configuration example of an opening / closing mechanism used in the first embodiment. [Figure 6] 4 is a schematic diagram showing the movement control of the wire connection mechanism 26 by the movement mechanism 25. FIG. [Figure 7] 13 is a schematic diagram showing an example of a process in which the wire connecting mechanism 26 twists together the wire legs W. FIG. [Figure 8] 13 is a schematic diagram showing an example of a process in which the wire connecting mechanism 26 twists together the wire legs W. FIG. [Figure 9] 13 is a schematic diagram showing an example of a process in which the wire connecting mechanism 26 twists together the wire legs W. FIG. [Figure 10] 13 is a schematic diagram showing an example of a process in which the wire connecting mechanism 26 twists together the wire legs W. FIG. [Figure 11] 13 is a schematic diagram showing an example of a process in which the wire connecting mechanism 26 twists together the wire legs W. FIG. [Figure 12] 2 is a block diagram showing a hardware configuration of a control device 30. FIG. [Figure 13] FIG. 2 is a block diagram showing the functional configuration of a control device 30. [Figure 14] 13 is a block diagram showing a control algorithm of an operation control unit 312. FIG. [Figure 15] 4 is a flowchart illustrating the flow of an operation control process executed by the remote wiring system 1. [Figure 16] 1 is a flowchart illustrating a flow of a remote wiring process executed by the remote wiring system 1. [Figure 17]FIG. 13 is a schematic diagram showing the concept of a control algorithm in the first modification. [Figure 18] 13 is a schematic diagram (top view) showing a configuration example of a wire connection mechanism 26 having an opening / closing mechanism for capturing a leg wire W. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0009] Hereinafter, an embodiment of the present invention will be described with reference to the accompanying drawings.

[0010] [System Configuration] FIG. 1 is a schematic diagram showing the overall configuration of a remote wiring system 1 according to this embodiment. As shown in Fig. 1, the remote wiring system 1 includes an operation device 10, a wiring device 20, and a control device 30. Fig. 1 also illustrates a user U who operates the remote wiring system 1, a camera C that takes images to assist the operation of the user U, an aerial work vehicle A that moves the wiring device 20 and the camera C, a face F, and multiple charge holes H provided at the face F. A parent die D equipped with an electric detonator is installed in the charge hole H, and a leg wire W (an electric wire in which a conductor that serves as a core is covered with an insulator) connected to the electric detonator of the parent die D is exposed (hanging down) from the charge hole H. Among these, the operating device 10 and the control device 30 are placed near the user U, and the wiring device 20 and the camera C are placed near the charge hole H by the aerial work vehicle A. Note that instead of the aerial work vehicle A, other mobile machines such as a hydraulic jumbo (e.g., a drill jumbo) or a mobile crane may be used.

[0011] The parent die D is a pouch-shaped explosive containing a water-containing explosive and a general electric detonator or an electronic delay type electric detonator for detonating the water-containing explosive. Although not shown, in addition to the parent die D, an additional die (a pouch-shaped explosive containing only explosives, such as a cylindrical or granular water-containing explosive sealed in a paper tube, a granular amphoteric explosive, or a liquid or gel explosive (e.g., a bulk emulsion explosive), without including an electric detonator, which explodes by detonation of the parent die D, can be appropriately installed. In addition, a filling made of clay or the like, called anko, can be appropriately installed to block the opening of the charge hole H. The terms "parent die, additional die, anko" and the like are commonly used by those skilled in the art, and therefore these terms will be used as they are in this specification.

[0012] The control device 30 is connected to be able to communicate with each of the operation device 10, the wiring device 20, and the camera C. This communication may be wired or wireless, and the communication method is not limited. This communication may be performed directly between the devices, or may be performed via a network such as the Internet.

[0013] In such a remote wire connection system 1, the operation device 10 operates as a leader device (which may also be referred to as a master device, etc.) to drive a mechanism that accepts operations from a user U. On the other hand, the wire connection device 20 operates as a follower device (which may also be referred to as a slave device, etc.) to drive a mechanism that performs wire connection work that involves contact with objects (here, the landing wire W and the face F). In this case, the control device 30 performs control (bilateral control) to transmit haptic sensations between the operation device 10 and the wire connection device 20. As a result, a user's operation on the operation device 10 (input of position and force) is transmitted as an operation of the wire connection device 20, and an external force input to the wire connection device 20 is transmitted as a reaction force (response of position and force) output by the operation device 10. The control device 30 also transmits instruction signals from the operation device 10 to the wire connection device 20, and causes the wire connection device 20 to perform operations for wire connection (gripping the leg wires W, removing the coating (cutting and peeling off the coating, etc.), twisting the two leg wires W, etc.).

[0014] In this manner, in this embodiment, the wire connection work is realized by remote operation by the user U. Therefore, in this embodiment, in at least a part of the wire connection work, the user U does not need to work close to the charge hole H provided in the face F, and the safety of the user U can be ensured even if a skin drop or the like occurs. In addition, in this embodiment, control that transmits haptic sensation (bilateral control) is performed. Therefore, the user U can perform the wire connection work more appropriately while feeling the reaction force from the wire connection device 20, as if he / she were working close to the head wire W hanging down from the face F, even though the wire connection work is performed remotely. In this embodiment, the process from gripping the leg wires W to twisting the two leg wires W is automatically performed by the wire connection device 20 without an operator directly touching the leg wires W. This makes it possible to more reliably connect the leg wires W of multiple electric detonators in series. Therefore, according to this embodiment, a technique that enables more appropriate electrical connection can be realized. The above is an outline of this embodiment. The present invention can be widely applied not only to the case of connecting the leg wires of explosives, but also to the case of making electrical connections remotely.

[0015] [Device configuration] Next, the configuration of each device included in the remote wiring system 1 will be described. FIG. 2 is a block diagram showing the hardware configuration of the operation device 10 and the wiring device 20. As shown in FIG. As indicated by the reference numerals in Fig. 2, the operating device 10 includes a driver, an actuator, and a position sensor of a first system for transmitting a haptic sensation. Specifically, the operating device 10 includes, as the first system for transmitting a haptic sensation, an actuator 12a (a reaction force applying means for the first operating mechanism 15) for driving a first operating mechanism 15 serving as an operating means of the moving mechanism 25, a driver 11a for driving the actuator 12a, and a position sensor 13a for detecting the position of a movable part of the first operating mechanism 15 moved by being driven by the actuator 12a. The operating device 10 also includes a second system for transmitting a control signal from the operating device 10 to the wire connection device 20 without transmitting a haptic sensation, and in the second system, a signal mainly instructing the operation of the wire connection device 20 is transmitted and received in response to the operation of a second operating mechanism 16 serving as an operating means of the wire connection device 20. The operation device 10 also includes a communication unit 14 for communicating between the first system driver 11a, the position sensor 13a, etc. and the control device 30, a first operation mechanism 15, and a second operation mechanism 16.

[0016] On the other hand, the wire connection device 20 also includes a driver, an actuator, and a position sensor corresponding to a first system that transmits a haptic sensation. Specifically, the wire connection device 20 includes, as the first system, an actuator 22a for driving a moving mechanism 25, a driver 21a for driving the actuator 22a, and a position sensor 23a for detecting the position of a movable part of the moving mechanism 25 that is moved by being driven by the actuator 22a. The wire connection device 20 also includes a second system that transmits a control signal from the operating device 10 to the wire connection device 20 without transmitting a haptic sensation, and the second system controls each actuator included in a wire connection mechanism 26 described later. The wire connection device 20 also includes a communication unit 24 for communicating between the first system driver 21a and the position sensor 23a and the control device 30, a movement mechanism 25, and a wire connection mechanism .

[0017] In this case, the position of the movable part of first operation mechanism 15 detected by position sensor 13a is, for example, the position of a predetermined part of the movable part of first operation mechanism 15. However, instead of the position of the movable part of first operation mechanism 15, the position of a predetermined part of the user operating first operation mechanism 15 may be used. Further, the position of the movable part of the moving mechanism 25 detected by the position sensor 23a is, for example, the position of a predetermined part of the movable part of the moving mechanism 25. However, instead of the position of the movable part of the moving mechanism 25, the position of a predetermined part where the moving mechanism 25 indirectly contacts an object (for example, the position of the tip of the hook-shaped member K2 of the hook mechanisms 208L and 208R described later) may be used.

[0018] Furthermore, in this embodiment, instead of the position of the movable part of the first operating mechanism 15 or the position of the movable part of the moving mechanism 25, the rotation angle of the output shaft of each actuator may be detected by a rotary encoder built into each actuator. That is, in this embodiment, the concept of position includes an angle (for example, the rotation angle of the output shaft of the actuator, etc.), and information related to position includes position, angle, velocity, angular velocity, acceleration, and angular acceleration. Furthermore, since position and velocity (or acceleration) or angle and angular velocity (or angular acceleration) are parameters that can be replaced by differential and integral calculations, when processing related to position or angle, it is possible to replace them with velocity or angular velocity, etc. as appropriate before processing.

[0019] The first operation mechanism 15 and the second operation mechanism 16 are mechanisms for receiving user operations, and their shapes and structures are not particularly limited. For example, the first operation mechanism 15 and the second operation mechanism 16 are realized by a controller having a movable part that receives user operations, or a device in the shape of a finger worn by a user. More specifically, the first operation mechanism 15 and the second operation mechanism 16 can be realized by an operation mechanism that is widely used in industrial machines, such as a joystick (control stick) that can input directions by tilting a rod-shaped operation tool. In addition, the second operation mechanism 16 can be realized by a button or the like that causes the wiring mechanism 26 to execute a preset operation (grasping, removing the coating (cutting and peeling the coating, etc.), or twisting operation, etc.).

[0020] On the other hand, the moving mechanism 25 is a mechanism for moving the wire connection mechanism 26, and the shape and structure thereof are also not particularly limited. For example, the moving mechanism 25 is realized by a robot manipulator or a robot arm that is attached to and moves the wire connection mechanism 26, or a conveying device that moves the wire connection mechanism 26 three-dimensionally. The wire connection mechanism 26 has a function of hooking (capturing) and holding the leg wire W, a function of stripping the coating (removing only the coating while leaving the core material), a function of cutting off the excess portion, a function of twisting the two leg wires W, and the like, but the detailed structure of the wire connection mechanism 26 will be described later.

[0021] In such a configuration, the control device 30 outputs a control command to the driver 11a or 21a based on the position detected by the position sensor 13a or 23a, thereby realizing bilateral control for transmitting haptics between the operation device 10, which is a leader device, and the wiring device 20, which is a follower device. More specifically, the control device 30 performs control (bilateral control) for transmitting haptics between the first operation mechanism 15 corresponding to the first system of the operation device 10 and the movement mechanism 25 corresponding to the first system of the wiring device 20. The control device 30 also performs control for transmitting control signals corresponding to the operation of buttons and the like constituting the second system of the operation device 10 to the actuators of the wiring mechanism 26 corresponding to the second system of the wiring device 20.

[0022] In this embodiment, since the first operation mechanism 15 of the control device 30 and the moving mechanism 25 of the wire connection device 20 have different device configurations, the components of the movement direction may be matched between the movement of the actuator that can apply a reaction force to the first operation mechanism 15 (for example, vertical, horizontal, and up-down directions) and the multiple actuators provided in the moving mechanism 25 (for example, actuators provided in each joint of a multi-joint robot). That is, the components of the movement in the moving mechanism 25 may be assigned to the components of the vertical movement, horizontal movement, and up-down movement in the first operation mechanism 15, respectively, and the transmission of the haptic sensation may be controlled for each assigned component. Note that the number of actuators in the first operation mechanism 15 of the control device 30 and the moving mechanism 25 of the wire connection device 20 may be matched, and the transmission of the haptic sensation may be controlled for each corresponding actuator. A specific algorithm for realizing control for transmitting the haptic sensation (bilateral control) will be described later with reference to FIG.

[0023] FIG. 3 is a schematic diagram (perspective view) showing the external configuration of the wire connection mechanism 26. As shown in FIG. In the wire connection mechanism 26, the side facing the leg wire W of the object to be grasped is referred to as the front, the opposite side as the back, the right side as viewed from the front as the right side, and the left side as viewed from the front as the left side. The wire connection mechanism 26 has a configuration that is approximately symmetrical when viewed from the front. In the following description, the symbol L representing a component indicates the component on the left side as viewed from the front, and R indicates the component on the right side as viewed from the front, and the mechanism consisting of the components on the right side as viewed from the front will be referred to as the "first processing mechanism" and the mechanism consisting of the components on the left side as viewed from the front as the "second processing mechanism".

[0024] As shown in FIG. 3, the wiring mechanism 26 includes a vertical support plate 201, a first horizontal support member 202, vertical shafts 203L, 203R, vertical shaft gears 204L, 204R, peeling actuators 205L, 205R, peeling gears 206L, 206R, first brackets 207L, 207R, hook mechanisms 208L, 208R, and hook mechanism actuators 209L, 209R. R, upper gripping members 210L, 210R, actuators 211L, 211R for moving the upper gripping members 210L, 210R forward and backward, cam followers 212L, 212R for opening and closing the upper gripping members 210L, 210R, second brackets 213L, 213R, peeling members 214L, 214R, actuators 215L, 215R for moving the peeling members 214L, 214R forward and backward, and a peeling member 215R. cam followers 216L, 216R for opening and closing the separating members 214L, 214R, third brackets 217L, 217R, lower holding members 218L, 218R, actuators 219L, 219R for moving the lower holding members 218L, 218R, cam followers 220L, 220R for opening and closing the lower holding members 218L, 218R, a second horizontal support member 221, and a torsional motion shaft 222. 2, a torsion actuator 223, a lifting actuator 224, a third horizontal support member 225, a fourth bracket 226L, 226R, excess length cutting members 227L, 227R, actuators 228L, 228R for moving the excess length cutting members 227L, 227R forward and backward, and cam followers 229L, 229R for opening and closing the excess length cutting members 227L, 227R.

[0025] The vertical support plate 201 is a plate-like member that supports the entire wire connection mechanism 26, and when the wire connection mechanism 26 is in use, the vertical support plate 201 is maintained in a position that is approximately perpendicular to the horizontal plane. The first horizontal support member 202 is a plate-like member fixed to the vertical support plate 201, and is installed so that its plate surface is perpendicular to the vertical support plate 201 (that is, approximately horizontal when in use). The vertical shafts 203L, 203R are lifting shafts that are fixed to the vertical support plate 201 and extend in a direction along the vertical support plate 201. In this embodiment, a screw groove is formed on the surface of the vertical shafts 203L, 203R, and the vertical shafts 203L, 203R are configured to be rotatable in conjunction with the rotation of the peeling actuators 205L, 205R described later.

[0026] The vertical shaft gears 204L, 204R are disk-shaped or cylindrical gears fixed coaxially to the upper ends of the vertical shafts 203L, 203R, and have teeth on their outer circumferential surfaces that mesh with the peeling gears 206L, 206R of the peeling actuators 205L, 205R. The peeling actuators 205L, 205R output driving forces for raising and lowering the peeling members 214L, 214R. The peeling gears 206L, 206R are disk-shaped or columnar gears fixed coaxially with the output shafts of the peeling actuators 205L, 205R, and have teeth formed on their outer circumferential surfaces to mesh with the vertical shaft gears 204L, 204R.

[0027] The first brackets 207L, 207R are support members including a bottom plate portion, an upright portion that stands vertically from the bottom plate portion on the rear side, and a top plate portion that extends parallel to the bottom plate portion from the upper end of the support portion. The bottom plate portions of the first brackets 207L, 207R are fixed to the upper surface of the first horizontal support member 202. The hook mechanisms 208L, 208R are provided on the upper surfaces of the first brackets 207L, 207R and have a hook-like configuration for capturing the leg wire W hanging down in the air.

[0028] FIG. 4 is a schematic diagram showing a top view of the wire connection mechanism 26. As shown in FIG. As shown in FIG. 4, the hook mechanism 208L, 208R includes an arm K1 extending forward (in a direction protruding toward the front side) of the wire connection mechanism 26, and a hook-shaped member K2 installed at the tip of the arm K1. The hook-shaped member K2 of the hook mechanism 208L, 208R includes a movable piece K3 that switches the hook-shaped member K2 between an open state and a closed state. In this embodiment, the movable piece K3 has a configuration consisting of a part of a ring, and one end of the movable piece K3 is connected to the tip of the arm K1 so as to be rotatable in the horizontal direction. When the hook-shaped member K2 is in a closed state, the movable piece K3 rotates at one end, and the other end is held in a state in which it is located near the arm K1. However, a gap is formed between the arm K1 and the other end of the hook-shaped member K2, allowing the leg wire W to pass through. Therefore, when the hook-shaped members K2 of the hook mechanisms 208L and 208R are closed, the wire connection mechanism 26 can be moved to introduce the leg wire W into the hook-shaped member K2 through the gap between the arm part K1 and the hook-shaped member K2, and the leg wire W cannot be easily removed from the hook-shaped member K2. That is, when the hook-shaped members K2 of the hook mechanisms 208L and 208R are closed, the leg wire W can be captured inside the hook-shaped member K2. On the other hand, when the hook-shaped members K2 are open, the movable piece K3 rotates at one end, and the other end is held in a state where it is positioned at the almost front end of the hook mechanisms 208L and 208R. Therefore, the leg wire W can be easily removed from the inside of the hook-shaped member K2, and the leg wire W is released. With this configuration, the hook mechanisms 208L, 208R can catch the leg wires W without requiring large opening and closing movements. Therefore, a configuration can be realized that can capture the leg wire W more reliably in a smaller space.

[0029] Returning to Fig. 3, the hook mechanism actuators 209L, 209R output a driving force for opening and closing the movable piece K3 of the hook mechanism 208L, 208R. In this embodiment, the hook mechanism actuators 209L, 209R are installed at the end (the part where the hook mechanism 208L, 208R is fixed to the first bracket 207L, 207R) opposite to the tip where the movable piece K3 of the hook mechanism 208L, 208R is installed. Therefore, the hook mechanism actuators 209L, 209R rotate the movable piece K3 located at a separated position via a member such as a wire or a belt, and change the hook-shaped member K2 to a closed state or an open state. The upper gripping members 210L, 210R are disposed inside the first brackets 207L, 207R, and include an opening and closing mechanism for gripping the leg wire W.

[0030] FIG. 5 is a schematic diagram showing a configuration example of the opening and closing mechanism used in this embodiment. 5 is used in common by the upper gripping members 210L, 210R, the peeling members 214L, 214R, the lower gripping members 218L, 218R, and the excess length cutting members 227L, 227R. The configuration will be described below using as an example a case where the opening and closing mechanism is provided in the upper gripping member 210L. In Figure 5, (a) is a top view of the two movable members G1 in an open state, (b) is an oblique view of the state in which the upper gripping member 210L is housed in the first bracket 207L, (c) is an oblique view of the state in which the upper gripping member 210L protrudes from the first bracket 207L to the front side, and (d) is an oblique view of the state in which the upper gripping member 210L protrudes most to the front side from the first bracket 207L.

[0031] As shown in FIG. 5, two movable members G1 for gripping the leg wire W are rotatably connected at one end, and a clamping portion G2 for clamping the leg wire W is provided at the other end (tip). The rotating shaft to which the two movable members G1 of the upper gripping member 210L are rotatably connected is fixed to a rack gear G3, and the rack gear G3 advances and retreats in a direction protruding from the first bracket 207L to the front side of the wire connection mechanism 26 by the advance / retract actuator 211L of the upper gripping member 210L. Furthermore, an opening / closing cam follower 212L fixed to the first bracket 207L is installed between the movable members G1. A groove into which the opening / closing cam follower 212L fits is formed on the inside of the movable member G1, and the groove portions on the tip side and the rotating shaft side of the movable member G1 are enlarged according to the size of the opening / closing cam follower 212L.

[0032] In addition, an elastic force is applied to the rotating shaft connecting the two movable members G1 in a direction to close the two movable members G1. Therefore, when the upper gripping member 210L is retracted into the first bracket 207L and is housed therein, the opening / closing cam follower 212L is housed in the enlarged groove on the tip side of the movable member G1, and the two movable members G1 are in a closed state. On the other hand, when the forward / backward actuator 211L moves the rack gear G3 and the movable member G1 moves in a direction protruding toward the front side of the wire connection device 20, the opening / closing cam follower 212L pushes the two movable members G1 open, and the two movable members G1 are in an open state. Then, when the rack gear G3 is moved to the position where the two movable members G1 are most protruding, the opening / closing cam followers 212L and 212R are housed in the enlarged groove on the rotating shaft side of the movable member G1, and the two movable members G1 are in a closed state. That is, the upper gripping member 210L is in a closed state when housed in the first bracket 207L, in an open state when moved in a direction protruding from the first bracket 207L, and in a closed state again when moved to the most protruding position. When the upper gripping member 210L is in a state of being most protruding from the first bracket 207L, the clamping portion G2 is located directly below (vertically below) the hook-shaped member K2 of the hook mechanism 208L. Therefore, when the upper gripping member 210L is moved in a direction protruding from the first bracket 207L, it is in an open state, and the leg wire W can be received between the clamping portions G2, and when moved to the most protruding position, the clamping portions G2 are closed to clamp the leg wire W.

[0033] Returning to FIG. 3, the advance / retract actuators 211L, 211R of the upper gripping members 210L, 210R output a driving force for advancing and retracting the rack gear G3 in a direction protruding from the first brackets 207L, 207R to the front side of the wiring mechanism 26. In this embodiment, a disk-shaped or cylindrical gear is coaxially fixed to the output shaft of the advance / retract actuators 211L, 211R, and this gear meshes with the rack gear G3 via an intermediate gear. Therefore, the advance / retract actuators 211L, 211R of the upper gripping members 210L, 210R can be arranged at a certain distance from the movable member G1 of the upper gripping members 210L, 210R.

[0034] The opening / closing cam followers 212L, 212R of the upper gripping members 210L, 210R are installed between the two movable members G1 in the upper gripping members 210L, 210R and fixed to the first brackets 207L, 207R. The opening / closing cam followers 212L, 212R are fitted into grooves formed on the inside of the movable members G1, and as described above, when the two movable members G1 move, the two movable members G1 change between an open state and a closed state depending on the position of the fitted groove.

[0035] The second brackets 213L, 213R are support members that include a bottom plate, an upright portion that stands vertically from the bottom plate on the rear side, and a top plate that extends parallel to the bottom plate from the upper end of the support portion. The second brackets 213L, 213R have a through hole with a screw groove at the end on the rear side, and the vertical shafts 203L, 203R are inserted through the through hole. The screw groove is formed on the surface of the vertical shafts 203L, 203R, and engages with the screw groove formed in the through hole of the second brackets 213L, 213R, converting the rotational motion of the vertical shafts 203L, 203R into the lifting and lowering motion of the second brackets 213L, 213R. Since the second brackets 213L, 213R are configured as independent members, they can be raised and lowered independently in response to the rotation of the peeling actuators 205L, 205R, respectively (that is, the rotation of the vertical shafts 203L, 203R, respectively).

[0036] The peeling members 214L, 214R are installed inside the second brackets 213L, 213R, and have two movable members G1 for gripping the leg wire W rotatably connected at one end, and a clamping part G2 for removing (here, cutting) the covering of the leg wire W at the other end (tip). That is, the clamping part G2 provided on the peeling members 214L, 214R has a cutting blade for cutting the covering of the leg wire W. The peeling members 214L, 214R also have an opening and closing mechanism similar to that of the upper gripping members 210L, 210R. That is, the rotating shaft to which the peeling members 214L, 214R are rotatably connected is fixed to a rack gear G3, and the rack gear G3 advances and retreats in a direction protruding from the second brackets 213L, 213R to the front side of the wire connection mechanism 26 by the advancement and retreat actuators 215L, 215R of the peeling members 214L, 214R. Furthermore, between the movable members G1, opening / closing cam followers 216L, 216R fixed to the second brackets 213L, 213R are installed. Grooves into which the opening / closing cam followers 216L, 216R fit are formed on the inside of the movable member G1, and the groove portions on the tip side and the rotating shaft side of the movable member G1 are enlarged to match the size of the opening / closing cam followers 216L, 216R.

[0037] The rotating shaft connecting the two movable members G1 is given an elastic force in a direction to close the two movable members G1. Therefore, when the peeling members 214L, 214R are retracted into the second brackets 213L, 213R and housed therein, the opening / closing cam followers 216L, 216R are housed in the enlarged grooves on the tip side of the movable members G1, and the two movable members G1 are in a closed state. On the other hand, when the forward / backward actuators 215L, 215R move the rack gear G3 and the movable member G1 moves in a direction protruding toward the front side of the wire connection device 20, the opening / closing cam followers 216L, 216R push the two movable members G1 open, and the two movable members G1 are in an open state. When the rack gear G3 is moved to the position where the two movable members G1 are most protruding, the opening / closing cam followers 216L, 216R are accommodated in the enlarged groove on the rotating shaft side of the movable members G1, and the two movable members G1 are in a closed state. That is, when the peeling members 214L, 214R are accommodated in the second brackets 213L, 213R, they are in a closed state, when they are moved in a direction protruding from the second brackets 213L, 213R, they are in an open state, and when they are moved to the most protruding position, they are in a closed state again. When the peeling members 214L, 214R are in a state where they are most protruding from the second brackets 213L, 213R, the clamping portion G2 is located directly below (vertically below) the hook-shaped members K2 of the hook mechanisms 208L, 208R. Therefore, when the peeling members 214L, 214R are moved in a direction protruding from the second brackets 213L, 213R, they are in an open state, allowing the leg wire W to be received between the clamping portions G2, and when they are moved to the most protruding position, the clamping portions G2 are closed and are in a state in which the coating of the leg wire W is cut.

[0038] The advance / retract actuators 215L, 215R of the peeling members 214L, 214R output a driving force for advancing / retracting the rack gear G3 in a direction protruding from the second brackets 213L, 213R to the front side of the wire connection mechanism 26. The advance / retract actuators 215L, 215R of the peeling members 214L, 214R have the same configuration as the advance / retract actuators 211L, 211R of the upper gripping members 210L, 210R. The opening / closing cam followers 216L, 216R of the peeling members 214L, 214R are disposed between the two movable members G1 of the peeling members 214L, 214R and fixed to the second brackets 213L, 213R. The opening / closing cam followers 216L, 216R of the peeling members 214L, 214R have the same configuration as the opening / closing cam followers 212L, 212R of the upper gripping members 210L, 210R.

[0039] The third brackets 217L, 217R are support members including a bottom plate portion, an upright portion that stands vertically from the bottom plate portion on the rear side, and a top plate portion that extends parallel to the bottom plate portion from the upper end of the support portion. The bottom plate portions of the third brackets 217L, 217R are fixed to the upper surface of the second horizontal support member 221. The lower gripping members 218L, 218R are installed inside the third brackets 217L, 217R, and include an opening and closing mechanism for gripping the leg wire W. The lower gripping members 218L, 218R have the same configuration as the upper gripping members 210L, 210R.

[0040] The advance / retract actuators 219L, 219R of the lower gripping members 218L, 218R output a driving force for advancing and retracting the rack gear G3 in a direction protruding from the third brackets 217L, 217R to the front side of the wiring mechanism 26. The advance / retract actuators 219L, 219R of the lower gripping members 218L, 218R have the same configuration as the advance / retract actuators 211L, 211R of the upper gripping members 210L, 210R. The opening / closing cam followers 220L, 220R of the lower gripping members 218L, 218R are installed between the two movable members G1 of the lower gripping members 218L, 218R and fixed to the third brackets 217L, 217R. The opening / closing cam followers 220L, 220R of the lower gripping members 218L, 218R have the same configuration as the opening / closing cam followers 212L, 212R of the upper gripping members 210L, 210R.

[0041] The second horizontal support member 221 is rotatably supported on the torsional motion shaft 222 and includes an arm extending substantially horizontally for supporting the third brackets 217L, 217R. In this embodiment, the second horizontal support member 221 includes a rotation support arm extending in a direction away from the torsional motion shaft 222 (in FIG. 3, a direction toward the back side of the wiring mechanism 26) and a bracket support arm extending to the left and right from the tip of the rotation support arm. The twisting motion shaft 222 is located in the middle of the hook members K2 of the hook mechanisms 208L, 208R in top view, and is a vertical rotation shaft that rotatably supports the second horizontal support member 221. Since the twisting motion shaft 222 is located in the middle of the hook members K2 of the hook mechanisms 208L, 208R (i.e., in the middle of the two captured leg wires W), when a twisting motion is performed, the two leg wires W do not undergo unnecessary rotational movement, and a simple and efficient twisting motion can be performed around the position of the twisting motion shaft 222.

[0042] The torsional actuator 223 outputs a driving force that rotates the second horizontal support member 221 around the torsional motion shaft 222. In this embodiment, the rotation shaft of the torsional actuator 223 is connected to the torsional motion shaft 222 via a belt, and is installed at a position separated from the torsional motion shaft 222 (in this embodiment, at a position on the front side in the space between the fourth brackets 226L, 226R).

[0043] The lifting actuator 224 is installed on the third horizontal support member 225 and outputs a driving force to raise and lower the part consisting of the third bracket 217L, 217R, the lower holding members 218L, 218R, the opening / closing cam followers 220L, 220R of the lower holding members 218L, 218R, the second horizontal support member 221, the torsional operating axis 222, and the torsional actuator 223 (hereinafter referred to as the "torsional rotation unit T") relative to the third horizontal support member 225. The advance / retract actuators 219L, 219R of the lower gripping members 218L, 218R are installed on the third horizontal support member 225 side, and when the torsional rotation unit T is lifted by the lifting actuator 224, the gears are disengaged from the output shafts of the advance / retract actuators 219L, 219R, enabling the torsional rotation unit T to rotate. Since the main bodies of the advance / retract actuators 219L, 219R are not installed on the torsional rotation unit T, the torsional rotation unit T can be rotated with a smaller rotational torque.

[0044] The third horizontal support member 225 is a plate-like member fixed to the vertical support plate 201, and is installed so that its plate surface is vertical (i.e., approximately horizontal when in use) to the vertical support plate 201. Furthermore, a lifting actuator 224 is installed on the third horizontal support member 225, and a torsional rotation unit T is supported so as to be liftable and lowerable. The fourth brackets 226L, 226R are support members each having a bottom plate portion, an upright portion that stands vertically from the bottom plate portion on the rear side, and a top plate portion that extends parallel to the bottom plate portion from the upper end of the support portion. The top plate portions of the fourth brackets 226L, 226R are fixed to the lower surface of the third horizontal support member 225.

[0045] The slack cutting members 227L, 227R are installed inside the fourth brackets 226L, 226R, and have two movable members G1 for gripping the leg wire W rotatably connected at one end, and a clamping part G2 for cutting the leg wire W at the other end (tip). The slack cutting members 227L, 227R have the same configuration as the peeling members 214L, 214R. However, the clamping part G2 of the slack cutting members 227L, 227R is configured to completely cut the leg wire W including the core material.

[0046] The advance / retract actuators 228L, 228R of the slack cutting members 227L, 227R output a driving force for advancing and retracting the rack gear G3 in a direction protruding from the fourth brackets 226L, 226R to the front side of the wire connection mechanism 26. The advance / retract actuators 228L, 228R of the slack cutting members 227L, 227R have a similar configuration to the advance / retract actuators 211L, 211R of the upper gripping members 210L, 210R. The opening / closing cam followers 229L, 229R of the excess length cutting members 227L, 227R are disposed between the two movable members G1 of the excess length cutting members 227L, 227R and fixed to the fourth brackets 226L, 226R. The opening / closing cam followers 229L, 229R of the excess length cutting members 227L, 227R have a similar configuration to the opening / closing cam followers 212L, 212R of the upper gripping members 210L, 210R.

[0047] It should be noted that the specific shape of the above-mentioned wiring mechanism 26 is merely an example, and a different shape may be used as long as it can realize the above-mentioned function of the wiring mechanism 26. Since an electric detonator is used to explode the parent die D, it is preferable that the material of the wiring mechanism 26 be wood, FRP (Fiber Reinforced Plastics), or the like that is resistant to static electricity so that the electric detonator does not explode accidentally due to static electricity.

[0048] FIG. 6 is a schematic diagram showing the movement control of the wire connection mechanism 26 by the movement mechanism 25. As shown in FIG. 6, the moving mechanism 25 can grasp a predetermined portion (e.g., vertical support plate 201) on the rear side of the wiring mechanism 26, and can translate it in horizontal directions including the forward / backward direction and the left / right direction, and in vertical directions perpendicular to the horizontal plane (i.e., three-dimensional directions), and can rotate it around an axis. For example, a vertical articulated robot can be used as the moving mechanism 25. The degree of freedom of movement of the moving mechanism 25 can be, for example, six degrees of freedom, but can be appropriately selected within a range in which the leg line W can be captured. Furthermore, when the wire connection mechanism 26 grips two legs W to be connected, the legs W may be gripped from either the left or right mechanism (the first processing mechanism or the second processing mechanism). In the following description, it is assumed that the second processing mechanism in the wire connection mechanism 26 grips the wire leg W.

[0049] When the moving mechanism 25 moves the wire connecting mechanism 26, the wire connecting mechanism 26 is positioned so as to face the face F, and first, an operation is performed to capture one leg wire W to be connected with the hook-shaped member K2 of the hook mechanism 208L. At this time, the user U, who is an operator, grasps the positions of the leg wire W to be captured and the wire connecting mechanism 26 by directly looking at the image captured by the camera C or the wire connecting mechanism 26. In order to catch the leg wire W on the hook-shaped member K2 of the hook mechanism 208L, the user U, who is the operator, operates the first operating mechanism 15 of the operating device 10 to move the position of the moving mechanism 25 and position the wiring mechanism 26 near the leg wire W. In addition, when the leg wire W is positioned near the hook-shaped member K2 of the hook mechanism 208L in the wiring mechanism 26, the user U, who is the operator, operates the position of the wiring mechanism 26 so that the leg wire W is introduced into the hook-shaped member K2 through the gap in the hook-shaped member K2.

[0050] At this time, the control device 30 executes control (bilateral control) for transmitting a haptic sensation between the operation device 10 (first operation mechanism 15) and the wire connection device 20 (movement mechanism 25). Therefore, if an external force is applied during the process of capturing the leg wire W with the hook-shaped member K2 of the hook mechanism 208L, for example, the hook mechanism 208L abutting against the wall surface of the face F, the sensation is transmitted to the worker, or user U, via the first operating mechanism 15. Therefore, even when an operator moves the wire connection device 20 remotely, the position can be controlled by utilizing the feeling of touching an object, thereby preventing the wire connection device 20 from coming into contact with the working face F, etc., with excessively strong force.

[0051] Furthermore, when the leg wire W is caught by the hook-shaped member K2 of the hook mechanism 208L, the user U, who is the worker, operates the second system of the operating device 10 to instruct the wiring mechanism 26 to perform a process for wiring the leg wire W. In response to this instruction, the wiring mechanism 26 grasps a predetermined upper portion of the captured leg wire W, cuts the coating and shifts it downward, and also grasps a predetermined lower portion of the leg wire W where the core material is exposed, and cuts off the excess portion. The detailed operation of the wiring mechanism 26 will be described later.

[0052] Next, in order to catch the leg wire W on the hook-shaped member K2 of the hook mechanism 208R, the user U, who is the worker, performs a similar operation to catch the second leg wire W on the hook-shaped member K2 of the hook mechanism 208R. At this time, the control device 30 executes control (bilateral control) for transmitting a haptic sensation between the operation device 10 (first operation mechanism 15) and the wire connection device 20 (movement mechanism 25). Therefore, in the process of capturing the leg wire W with the hook-shaped member K2 of the hook mechanism 208R, if an external force acts, for example, the hook mechanism 208R abuts against the wall surface of the face F, the feeling of the force is transmitted to the user U, the worker, via the first operation mechanism 15. In addition, when capturing a second leg wire W, the wiring mechanism 26 is moved while the wiring mechanism 26 is holding the first leg wire W. Therefore, in the process of moving the wiring mechanism 26, if tension is generated in the held leg wire W, the feeling of the force is transmitted to the user U, the worker, via the first operation mechanism 15. Therefore, even when an operator moves the wire connecting device 20 remotely, the position can be controlled by utilizing the feeling of contact with an object or the feeling of tension generated in the object being held, thereby preventing the wire connecting device 20 from coming into contact with the face F, etc. with excessively strong force or from generating excessive tension in the leg wire W, causing it to be cut.

[0053] When the leg wire W is caught by the hook-shaped member K2 of the hook mechanism 208R, the user U, who is the worker, operates the second system of the operating device 10 to instruct the wiring mechanism 26 to perform a process for wiring the leg wire W, in the same manner as in the case of the first leg wire W. In response to this instruction, the wiring mechanism 26 grasps a predetermined upper portion of the captured leg wire W, cuts the coating and shifts it downward, and grasps a predetermined lower portion of the leg wire W where the core material is exposed, and cuts off the excess portion. This completes the preparation for twisting together the two lead wires W to be connected. Then, a user U, who is an operator, operates the second system of the operating device 10 to instruct the wire connection mechanism 26 to perform a process for twisting together the two leg wires W. In response to this instruction, the wire connection mechanism 26 executes an operation of twisting together the exposed portions of the core materials of the two leg wires W.

[0054] 7 to 11 are schematic diagrams showing an example of a process in which the wire connecting mechanism 26 twists the legs W together. As shown in FIG. 7(1), the wire connection mechanism 26 is moved by the movement mechanism 25 to the vicinity of the leg wire W of the object to be grasped in response to an operation of the first operation mechanism 15 of the operation device 10 by an operator (user U). 7(2), the wire connection mechanism 26 captures one of the two legs to be connected to one of the hook members K2 of the hook mechanisms 208L and 208R in response to an operation of the first operation mechanism 15 of the operation device 10 by an operator (user U). Here, it is assumed that the leg W is captured by the hook member K2 of the hook mechanism 208R.

[0055] Next, as shown in FIGS. 7(3) and (4), in response to an operation of the second operating mechanism 16 of the operating device 10 by an operator (user U), the wiring mechanism 26 grips a predetermined upper portion of the leg line W with the upper gripping member 210R. Next, as shown in FIGS. 7(5) and 7(6), the wire connection mechanism 26 removes (here, cuts) the coating of the lead wire W by the stripping member 214R. 8(7), the wire connection mechanism 26 lowers the peeling member 214R by the peeling actuator 205R, causing the covering of the leg wire W to shift downward, exposing the core material.

[0056] Next, as shown in FIGS. 8(8) and 8(9), the wire connection mechanism 26 grips a lower predetermined portion of the leg wire W with the lower gripping member 218R. 8(10)-(12), the wire connection mechanism 26 uses the slack cutting member 227R to cut off the slack (excess end portion) of the leg W. After cutting off the slack of the leg W, the slack cutting member 227R releases its grip on the leg W. As a result, the preparation process of the leg W by the first processing mechanism is completed.

[0057] Next, as shown in FIG. 9(13), the wire connection mechanism 26 is moved by the movement mechanism 25 to the vicinity of the leg wire W of the object to be grasped in response to an operation of the first operation mechanism 15 of the operation device 10 by an operator (user U). Next, as shown in Fig. 9 (14), the wiring mechanism 26 captures the other of the two legs to be connected to one of the hook members K2 of the hook mechanisms 208L, 208R in response to the operation of the operator (user U) on the first operation mechanism 15 of the operation device 10. Here, it is assumed that the leg W is captured by the hook member K2 of the hook mechanism 208L. At this time, in order to connect multiple parent dies D in series, when a positive leg W is captured as the first leg W, a negative leg W of another parent die D is captured as the second leg W.

[0058] Next, as shown in FIGS. 9(15) and (16), in response to an operation of the second operating mechanism 16 of the operating device 10 by an operator (user U), the wiring mechanism 26 grips a predetermined upper portion of the leg line W with the upper gripping member 210L. Next, as shown in FIGS. 9(17) and 9(18), the wire connection mechanism 26 removes (here, cuts) the coating of the leg wire W by the stripping member 214L. 10(19), the wire connection mechanism 26 lowers the peeling member 214L by the peeling actuator 205L, so that the covering of the leg wire W is shifted downward, exposing the core material.

[0059] Next, as shown in FIGS. 10(20) and 10(21), the wire connection mechanism 26 grips a lower predetermined portion of the leg W with the lower gripping member 218L. 10(22)-(24), the wire connection mechanism 26 cuts off the excess length (excess end portion) of the leg wire W by the excess length cutting member 227L. After cutting off the excess length of the leg wire W, the excess length cutting member 227L releases the grip of the leg wire W. As a result, the preparation process of the leg wire W by the second processing mechanism is completed. As a result, the two leg wires W are held with their core materials exposed, and preparation for twisting is completed.

[0060] Subsequently, as shown in FIG. 11 (25), the wiring mechanism 26 lifts the torsional rotation unit T by the lifting actuator 224 in response to the operation of the second operation mechanism 16 of the operation device 10 by the operator (user U). 11(26)-(28), the wire connection mechanism 26 rotates the torsional rotation unit T once around the torsional operation shaft 222 by the torsional actuator 223. As a result, the two leg wires W are twisted together and connected. Note that, although the number of rotations of the torsional rotation unit T is set to one rotation here, it may be set to two or more rotations as necessary.

[0061] Next, as shown in FIG. 11 (29), the wire connection mechanism 26 lowers the torsional rotation unit T by the lifting actuator 224. Furthermore, as shown in FIG. 11 (30), the wire connection mechanism 26 releases the grip of the upper gripping members 210L, 210R and the lower gripping members 218L, 218R, opens the hook-shaped members K of the hook mechanisms 208L, 208R, and releases the two legs W.

[0062] 7 to 11, the leg W is captured by one of the hook mechanisms 208L, 208R, the covering of the captured leg W is removed and the excess length is cut off, and then the leg W is captured by the other of the hook mechanisms 208L, 208R, and similarly the covering of the captured leg W is removed and the excess length is cut off, but the order of these processing steps is not limited to this. That is, the leg W may be captured by one of the hook mechanisms 208L, 208R, the leg W is captured by the other of the hook mechanisms 208L, 208R, and the covering of the two captured leg wires W may be removed and the excess length may be cut off in parallel or sequentially.

[0063] Through these steps, the wire connection mechanism 26 can capture the leg wire W by being moved to the moving mechanism 25 in response to the operation of the first operation mechanism 15 of the operation device 10 by the operator (user U), and can remove the coating of the captured leg wire W and cut off the excess portion in response to the operation of the second operation mechanism 16 of the operation device 10 by the operator (user U). Also, the wire connection mechanism 26 can perform an operation of twisting together the two leg wires whose coating has been removed and whose excess portion has been cut in response to the operation of the second operation mechanism 16 of the operation device 10 by the operator (user U). Therefore, the worker does not need to perform the work of connecting the leg wire W of the parent die D installed at the face F in close proximity to the charge hole H provided at the face F, and even if a skin fall or the like occurs, the safety of the worker can be ensured.

[0064] FIG. 12 is a block diagram showing the hardware configuration of the control device 30. As shown in FIG. As shown in FIG. 12, the control device 30 includes a processor 31, a ROM (Read Only Memory) 32, a RAM (Random Access Memory) 33, a bus 34, an input unit 35, an output unit 36, a memory unit 37, a communication unit 38, and a drive 39.

[0065] The processor 31 executes various processes according to a program recorded in the ROM 32 or a program loaded from the storage unit 37 to the RAM 33 . The RAM 33 also stores data and the like necessary for the processor 31 to execute various processes.

[0066] The processor 31, the ROM 32, and the RAM 33 are connected to one another via a bus 34. To the bus 34, an input unit 35, an output unit 36, a storage unit 37, a communication unit 38, and a drive 39 are connected.

[0067] The input unit 35 includes input devices such as a mouse and a keyboard, and receives various types of information input to the control device 30. The input unit 35 may include a microphone, and may receive various types of information by voice input from the worker. The output unit 36 ​​is composed of a display, a speaker, etc., and outputs images and sounds. The storage unit 37 is composed of a hard disk or a dynamic random access memory (DRAM) or the like, and stores various data managed by each server. The communication unit 38 controls communications with other devices via the network.

[0068] Removable media 40, such as a magnetic disk, an optical disk, a magneto-optical disk, or a semiconductor memory, is appropriately loaded into the drive 39. A program read from the removable media 40 by the drive 39 is installed in the storage unit 37 as necessary. It should be noted that the above hardware configuration is the basic configuration of the control device 30, and it is possible to adopt a configuration that does not include some of the hardware, to include additional hardware, or to change the implementation form of the hardware.

[0069] The control device 30 having such a hardware configuration performs "operation control processing" and "remote connection processing." Here, the operation control process is a series of processes that control the operation of each mechanism by performing control (bilateral control) to transmit haptic sensations between each mechanism driven by the operating device 10 and each mechanism driven by the wiring device 20. The remote wiring process is a series of processes that utilize the motion control process to support remote operation in the wiring work of the user U. The motion control process is realized as a subroutine of the remote wiring process.

[0070] FIG. 13 is a block diagram showing the functional configuration of the control device 30. As shown in FIG. When the above-mentioned operation control process and remote wiring process are performed, a physical quantity data acquisition unit 311, an operation control unit 312, a wiring instruction unit 313, an image data acquisition unit 314, and an image presentation unit 315 function in the processor 31, as shown in Fig. 13. In addition, a physical quantity data storage unit 371 and an image data storage unit 372 are formed in the storage unit 37. Including cases not specifically mentioned below, data required to realize processing is transmitted and received between these functional blocks at appropriate times as appropriate.

[0071] The physical quantity data acquisition unit 311 acquires physical quantity data for implementing the operation control process. For example, the physical quantity data acquisition unit 311 acquires the positions (specifically, positions or angles) of the movable parts of each mechanism moved by driving the actuators 12a and 22a from the position sensors 13a and 23a. The physical quantity data such as the positions acquired by the physical quantity data acquisition unit 311 is used as a reference value for the operation of each mechanism driven by the operating device 10 and the wiring device 20 in the algorithm for transmitting haptic sensations, which will be described later.

[0072] The operation control unit 312 controls the transmission of haptic sensations between each mechanism driven by the operating device 10 and each mechanism driven by the wire connection device 20, thereby controlling the operation of each mechanism. FIG. 14 is a block diagram showing a control algorithm of the operation control section 312. As shown in FIG. As shown in Fig. 14, the algorithm implemented in the operation control unit 312 is expressed as a control law including a functional force-velocity allocation conversion block FT, an ideal force source block FC, an ideal velocity (position) source block PC, and an inverse conversion block IFT. The control algorithm shown in Fig. 14 is described in a patent publication (Japanese Patent No. 6382203) of a patent right held by Keio University, which constitutes the applicant of the present application, and various control algorithms described in the patent publication can also be used appropriately in this embodiment. In this embodiment, the leader device in the controlled system CS is configured by the operating device 10, and the follower device is configured by the wiring device 20.

[0073] The functional force-speed allocation transformation block FT is a block that defines the transformation of the control energy into the domain of speed (position) and force that are set according to the function of the controlled system CS. Specifically, the functional force-speed allocation transformation block FT defines a coordinate transformation that takes as input the value (reference value) that is the standard for the function of the controlled system CS and the current position (or current angle) of the movable part of each mechanism that is moved by the actuators 12a and 22a. This coordinate transformation generally transforms an input vector whose elements are the reference value and the current position (current angle) into an output vector consisting of a position (angle) for calculating a control target value of the position (angle), and also transforms an input vector whose elements are the reference value and the current force into an output vector consisting of a force for calculating a control target value of the force.

[0074] By setting the coordinate transformation in the functional force-velocity allocation transformation block FT to the content representing the force-tactile transmission function, it is possible to realize the force-tactile transmission function between the operation device 10 and the wiring device 20, or to reproduce the operation of transmitting the force-tactile sensation in the wiring device 20 without using the operation device 10. Also, by setting coefficients in the elements of the transformation matrix in the coordinate transformation in the functional force-velocity allocation transformation block FT, it is possible to perform scaling of the position (angle) or force.

[0075] That is, in this embodiment, in the functional force / speed allocation conversion block FT, the variables (variables in real space) of the individual movable parts of each mechanism moved by the actuators 12a and 22a are "converted" into a group of variables (variables in space after coordinate conversion) of the entire system expressing the force haptic transmission function, and the control energy is assigned to the control energy of the position (angle) and the control energy of the force. That is, the coordinate conversion set in the functional force / speed allocation conversion block FT converts the coordinates (oblique coordinates) of the real space in which the position (angle) and the force are related to each other into the coordinates (orthogonal coordinates) of the virtual space in which the position (angle) and the force are independent from each other. Therefore, compared to the case where the control is performed as the variables (variables in real space) of the individual movable parts of each mechanism moved by the actuators 12a and 22a, it is possible to independently provide the control energy of the position (angle) and the control energy of the force, that is, to independently control the position (angle) and the force.

[0076] In this embodiment, for example, when controlling the position (angle) and force output by the operating device 10, the state value in the space after the coordinate transformation can be calculated under the condition that the difference in position (angle) is zero and the sum of forces is zero (an equal force is output in the opposite direction) between the position (angle) of the movable part of each mechanism moved by driving the actuator 12a and the input of the force calculated from these positions (angles) and the reference value serving as the reference for controlling the position (angle) and force. However, the reference value serving as the reference for controlling the position (angle) and force is the position (angle) of the movable part of each mechanism moved by driving the actuator 22a in the wiring device 20 and the force calculated from these positions (angles).

[0077] Similarly, in this embodiment, for example, when controlling the position (angle) and force output by the wiring device 20, the state value in the space after the coordinate transformation can be calculated under the condition that the difference in position (angle) is zero and the sum of forces is zero (an equal force is output in the opposite direction) between the position (angle) of the movable part of each mechanism moved by the actuator 12a in the operation device 10 and the input of the force calculated from these positions (angles), and the reference value serving as the reference for controlling the position (angle) and force. However, the reference value serving as the reference for controlling the position (angle) and force is the position (angle) of the movable part of each mechanism moved by the actuator 12a in the operation device 10 and the force calculated from these positions (angles).

[0078] The ideal force source block FC is a block that performs calculations in the force domain according to the coordinate transformation defined by the functional force-speed allocation transformation block FT. In the ideal force source block FC, a target value for the force when performing calculations based on the coordinate transformation defined by the functional force-speed allocation transformation block FT is set. This target value is set as a fixed value or a variable value according to the function to be realized. For example, when a function similar to the function indicated by the reference value is to be realized, zero can be set as the target value, and when scaling is performed, a value obtained by enlarging or reducing the information indicating the function indicated by the reference value can be set. In addition, the ideal force source block FC can set an upper limit value for the energy of the force determined by calculations in the force domain. By setting an upper limit value for the energy of the force, for example, a limit is imposed on the contact force when the wire connection mechanism 26 contacts the wall surface of the face F, and the wire connection mechanism 26 can be prevented from contacting an object too strongly.

[0079] The ideal velocity (position) source block PC is a block that performs calculations in the position (angle) domain according to the coordinate transformation defined by the functional force-speed allocation transformation block FT. In the ideal velocity (position) source block PC, a target value for the position (angle) when performing calculations based on the coordinate transformation defined by the functional force-speed allocation transformation block FT is set. This target value is set as a fixed value or a variable value according to the function to be realized. For example, when a function similar to the function indicated by the reference value is to be realized, zero can be set as the target value, and when scaling is performed, a value obtained by enlarging or reducing the information indicating the function to be reproduced can be set. In addition, the ideal velocity (position) source block PC can set an upper limit value for the energy of the position determined by calculations in the position (angle) domain. Setting an upper limit value for the energy of the position (angle) imposes a limit on the space in which the wiring mechanism 26 moves, and for example, it is possible to prevent the wiring mechanism 26 from entering the position of an object (e.g., the parent die D) with which contact should be avoided.

[0080] The inverse transformation block IFT is a block that inversely transforms values ​​in the position (angle) and force domains into values ​​in the input domain to the controlled system CS (for example, voltage values ​​or current values, etc.) (i.e., determines command values ​​in the real space). Under such a control algorithm, the time-series position (angle) detection values ​​detected by the position sensors 13a and 23a are input to the control device 30. These time-series position (angle) detection values ​​represent the operations of the actuators 12a and 22a, and the control device 30 applies coordinate transformation to transmit haptics to the input positions (angles) and forces derived from these positions (angles).

[0081] Returning to FIG. 13, the wiring instruction unit 313 sends instructions to the wiring mechanism 26 of the wiring device 20 for processing the leg wire W, thereby causing the wiring mechanism 26 to grasp the leg wire W to be connected, peel off the coating (in this case, this is the action of cutting only the coating and shifting it downward), cut off the excess portion of the leg wire W, and twist the two leg wires together.

[0082] The image data acquisition unit 314 acquires images captured by the camera C in real time through communication. For example, the camera C captures an image of the vicinity of the hook-shaped member K2 of the wiring mechanism 26 when the wiring mechanism 26 is moved by the moving mechanism 25. In order to more appropriately support the remote operation of the user U, it is preferable that the image captured by the camera C is a video image rather than a still image. It is also more preferable that the angle of view of the camera C can be changed by the user U through remote operation using the control device 30 or the like.

[0083] The image presentation unit 315 presents the images captured by the camera C and acquired by the image data acquisition unit 314 to the user U in real time. The presentation can be realized, for example, by displaying the images on a display included in the output unit 36. In this case, it is desirable to place the display in a position where the user U can refer to the images while operating each operation mechanism.

[0084] The physical quantity data storage unit 371 stores the physical quantity data acquired by the physical quantity data acquisition unit 311 and various parameters calculated by the operation control unit 312 based on the physical quantity data. The image data storage unit 372 stores the image data captured by the camera C acquired by the image data acquisition unit 314. The various data stored in these storage units can be used as a log associated with the wiring work. For example, it can be used to analyze the success or failure of the wiring work and the time required for the wiring work. Alternatively, it can be used as teaching material for teaching the remote operation procedure to a user U who has little experience in remote wiring work. Next, the details of each process performed by the remote wiring system 1 will be described.

[0085] [Motion control processing] 15 is a flowchart illustrating the flow of the operation control process executed by the remote wiring system 1. The operation control process is executed as a subroutine in the remote wiring process.

[0086] In step S1, the physical quantity data acquisition unit 311 acquires the position (angle) of a movable part of a mechanism that is to be moved by being driven by an actuator. For example, when the wiring mechanism 26 is moved by the moving mechanism 25, the physical quantity data acquisition unit 311 acquires the positions (angles) of the movable parts of the first operation mechanism 15 and the moving mechanism 25. In this case, the operation control unit 312 acquires the positions corresponding to these mechanisms from the position sensor 13a and the position sensor 23a.

[0087] In step S2, the motion control section 312 converts an input vector in the real space into a vector in the virtual space. In step S3, the motion control unit 312 executes calculations in the domain of velocity (position) and calculations in the domain of force.

[0088] In step S4, the motion control unit 312 inversely converts values ​​in the domains of velocity (position) and force into values ​​in the domain of input to the controlled system CS (vectors in real space). In step S5, the operation control section 312 outputs command values ​​for the actuator 12a and the actuator 22a.

[0089] In step S6, the operation control unit 312 determines whether or not the execution of a predetermined action, such as the movement of the wiring mechanism 26 by the moving mechanism 25, has been completed. The determination can be made by analyzing the physical quantity data acquired by the physical quantity data acquisition unit 311, or based on whether or not an operation to end the predetermined action has been performed by the user U. If the execution of the predetermined action has been completed, the result of the determination in step S6 is Yes, the process as a subroutine is terminated, and the process returns to the remote wiring process. On the other hand, if the execution of the predetermined action has not been completed, the result of the determination in step S6 is No, and the process returns to step S1 and is repeated.

[0090] According to the operation control process described above, the operation of each mechanism can be controlled by performing control (bilateral control) to transmit haptic sensations between each mechanism driven by the operating device 10 and each mechanism driven by the wiring device 20.

[0091] [Remote Wiring Processing] 16 is a flowchart illustrating the flow of a remote wiring process executed by the remote wiring system 1. The remote wiring process is executed when the operation device 10 or the control device 30 receives an instruction to start the remote wiring process from a user.

[0092] In step S11, the image data acquisition unit 314 acquires an image captured by the camera C. In step S12, the image presenting unit 315 presents the image captured by the camera C to the user U, who is the worker. The acquisition in step S11 and the presentation in step S12 are continued until this process is completed.

[0093] In step S13, the physical quantity data acquisition unit 311 detects, based on the physical quantity data corresponding to the first operating mechanism 15, that the first operating mechanism 15 has accepted remote operation by the user U to move the wiring mechanism 26 using the movement mechanism 25.

[0094] In step S14, the motion control unit 312 executes the motion control process described above as a subroutine. By the process of step S14, the leg wire W is caught by one of the hook mechanisms 208L, 208R of the wire connection mechanism 26. At this time, the user U, who is the worker, can feel the input of an external force (for example, a reaction force when the hook mechanisms 208L, 208R abut against the wall surface of the face F) to the wire connection mechanism 26 through the haptic sensation transmitted to the first operation mechanism 15. When the movement of the wire connection mechanism 26 using the movement mechanism 25 is completed, the motion control process is completed and proceeds to step S15.

[0095] In step S15, the wiring instruction unit 313 instructs the wiring mechanism 26 to remove the covering of the leg wire W and cut off the excess length in accordance with the operation of the second operation mechanism 16 by the user U. This removes the covering of the leg wire W that was just captured, and cuts off the excess length.

[0096] In step S16, the wire connection instruction unit 313 determines whether or not the second operation mechanism 16 has been instructed to perform a process of twisting the leg wires W together. If the second operation mechanism 16 has not been instructed to twist the leg wires W, the result of step S16 is NO, and the process proceeds to step S11. That is, the process of moving the wire connection mechanism 6 to capture the leg wires W is executed again. On the other hand, if a command has been issued to the second operation mechanism 16 to perform a process of twisting the leg wires W, the result of the determination in step S16 is YES, and the process proceeds to step S17.

[0097] In step S17, the wire connection instruction unit 313 instructs the wire connection mechanism 26 to twist the two held leg wires W according to the operation of the user U on the second operation mechanism 16 (the instruction operation for twisting the leg wires W). As a result, the torsional rotation unit T is lifted and rotated around the torsional operation shaft 222. As a result, the two leg wires W are twisted together and connected. Note that after the two leg wires W are twisted together, a configuration may be provided in which one leg wire W is held by the peeling member 214R and the other leg wire W is held by the peeling member 214L to check electrical continuity between the peeling member 214R and the peeling member 214L (i.e., a configuration to check the continuity of the two leg wires W).

[0098] In step S18, the connection instruction unit 313 determines whether or not an instruction to end the remote connection process has been issued. If the end of the remote wire connection process has not been instructed, the result of the determination in step S18 is NO, and the process proceeds to step S11. That is, the process of moving the wire connection mechanism 26 to capture the leg wire W is subsequently executed. If an instruction to end the remote wiring process is given, the result of the determination in step S18 is YES, and the remote wiring process ends.

[0099] According to the remote wiring process described above, the moving mechanism 25 can be remotely operated to capture the leg wire W to the wiring mechanism 26, and the leg wire W can be connected by operating the wiring mechanism 26. In addition, when the leg wire W is captured by the wire connection mechanism 26, the operation control process can be utilized to assist the user U in remote operation of the wire connection work. That is, in the remote wire connection system 1, when capturing the head wire W hanging down from the face F, haptics (force tactile transmission control) is applied so that the worker (user U) can determine whether the wire connection mechanism 26 has abutted against the face F. After that, the wire connection mechanism 26 automatically connects the two head wires W, thereby completing the wire connection work.

[0100] In this way, in the remote wire connection system 1, the main steps of the wire connection work can be performed by remote operation and automatic wire connection operation, so that the user U, who is the worker, does not need to work close to the face F where there is a risk of skin falling off, at least in part of the wire connection work. In addition, the force applied to the wire connection mechanism 26 is transmitted to the user U via the first operation mechanism 15. Therefore, even when the worker moves the wire connection mechanism 26 remotely, the user can operate the position by utilizing the feeling of touching an object or the feeling of tension generated in the object being held, and it is possible to prevent the wire connection device 20 from contacting the face F with excessively strong force or the leg wire W from being cut by generating excessive tension in the leg wire W. In addition, since the wire connection mechanism 26 automatically removes the coating of the leg wire W, cuts off the excess length, and twists the two leg wires W, electrical connection can be performed more reliably without relying on the experience or intuition of the worker. Therefore, according to the remote wiring system 1, electrical wiring can be performed more appropriately while ensuring the safety of the worker.

[0101] Generally, in wire connection work, it is necessary to be aware of collapse disasters such as surface falls, and to take measures such as monitoring during work and spraying concrete or the like onto the face to reinforce the face. However, according to this embodiment, since the safety of the user U can be ensured as described above, there is also an effect that such measures do not need to be taken more than necessary. The present invention can be applied not only to the connection of leg wires in blasting, but also to electrical connections in various objects, such as high places and environments with high levels of radiation that are not suitable for human work, and objects where workers need to perform a large number of similar tasks and where accumulated fatigue is a problem.

[0102] In the above embodiment, the case of connecting the leg wires W has been described as an example, but the application of the present invention is not limited to this. That is, the present invention can be widely applied to linear members consisting of a core material that serves as a conductor and a coating that covers the core material, and the present invention can be applied to members called cables, electric wires, wires, cords, etc. That is, the present invention can be applied to cases where various linear members are captured, and as an example, it can be applied to cases where linear members such as detonators with fuses, fuses, detonation cords, etc. In addition, with regard to the connection of the captured linear members, the work content can be appropriately adjusted according to the type of linear member to be connected.

[0103] [Variations] Although the embodiment of the present invention has been described above, this embodiment is merely an example and does not limit the technical scope of the present invention. The present invention can take various other embodiments and can be modified in various ways, such as omissions and substitutions, without departing from the gist of the present invention.

[0104] [Variation 1] In the above-described embodiment, the operation control unit 312 controls the operation of each mechanism by controlling the transmission of haptics between each mechanism driven by the operating device 10 and each mechanism driven by the wire connection device 20 based on the control algorithm described with reference to FIG. 12. This is not limiting, and the operation control unit 312 may control the operation of each mechanism using another control algorithm. For example, the operation control unit 312 may control the operation of each mechanism using a control algorithm described below as this modified example. In this case, the operation control unit 312 calculates command values ​​for the operating device 10 and the wire connection device 20 based on the control algorithm of this modified example described below, instead of the processing of steps S2 to 4 shown in FIG. 15, in the operation control process.

[0105] [Basic principle] FIG. 17 is a schematic diagram showing the concept of a control algorithm in this modified example. As shown in Fig. 17, in the control algorithm of this modification, a virtual object including a leader device and a follower device is assumed in a robot to which a leader-follower system is applied, and control is performed to make the operations of the leader device and the follower device follow the behavior of the virtual object when the input to the leader device and the follower device is the input to the virtual object. At this time, a parameter representing the speed is calculated by multiplying the force response input from the leader device and the follower device by the admittance, and is given to the position control system of the leader device and the follower device as a speed command value together with the current speed. This makes it possible to obtain performance in terms of repeatability and operability of the operations of the leader device and follower device that is equal to or better than that of the conventional technology. Therefore, it is possible to realize more appropriate physical interaction with the robot. In addition, the control algorithm of this modification can perform control based on a speed command value, and therefore has a high affinity with existing position (or speed) control systems (systems that do not assume acceleration control). However, the control algorithm of this modification can also perform control based on an acceleration command value. In addition, since position and velocity (or acceleration) or angle and angular velocity (or angular acceleration) are parameters that can be replaced by differential and integral calculations, when performing processing related to position or angle, it is possible to replace them with velocity or angular velocity, etc. as appropriate.

[0106] [Specific Control] The physical quantity data acquisition unit 311 acquires physical quantities acquired in the operation device 10 and the wire connection device 20 (here, positions of movable parts of each mechanism in the operation device 10 and the wire connection device 20). The operation control unit 312 calculates a speed command value (or a position command value) for making the operation device 10 and the wire connection device 20 follow the behavior of a virtual object (virtual object having mass m) assumed to include the operation device 10 and the wire connection device 20, based on the physical quantities of the operation device 10 and the wire connection device 20 acquired by the physical quantity data acquisition unit 311. Specifically, the operation control unit 312 calculates a speed command value for the operation device 10 and a speed command value for the wire connection device 20, for example, according to the following formulas (1) and (2).

[0107]

number

[0108] In addition, F 1 and F 2 can be obtained from the physical quantity (here, position) obtained from the operation device 10 and the wiring device 20 by using various force estimation methods (converting to acceleration and estimating as a multiplication value with mass, or estimating by an observer, etc.).1 and V 2 can be obtained by differentiating the physical quantity (here, position) obtained from the operation device 10 and the wiring device 20. However, the control device 30 may obtain the force as a physical quantity from the operation device 10 and the wiring device 20 and use it in the calculation of the formulas (1) and (2).

[0109] Furthermore, although equations (1) and (2) are shown for calculating a speed command value, it is also possible to calculate a position command value and control the operation device 10 and the wiring device 20 by the position command value. The operation control unit 312 can also calculate a speed command value for the operating device 10 and an acceleration command value for the wiring device 20 according to, for example, the following equations (3) and (4), and control the operating device 10 and the wiring device 20 by the acceleration command value. Furthermore, the operation control unit 312 can also calculate a current command value or a voltage command value for the actuator, and control the operating device 10 and the wiring device 20 by the current command value or the voltage command value for the actuator.

[0110]

number

[0111] The operation control unit 312 transmits the command value (here, speed command value) of the operating device 10 and the command value (here, speed command value) of the wire connection device 20 calculated in this manner to the operating device 10 and the wire connection device 20. At this time, it is also possible to calculate a position command value and control the operating device 10 and the wire connection device 20 by the position command value. At this time, it is also possible to calculate an acceleration command value and control the operating device 10 and the wire connection device 20 by the acceleration command value.

[0112] In the control algorithm of this modification, the operation device 10 and the wiring device 20 may be provided with force sensors that detect forces acting on the movable parts of the mechanisms of the operation device 10 and the wiring device 20, in addition to the position sensors 13a and 23a, and the forces acting on the movable parts of the mechanisms detected by the force sensors may be transmitted to the control device 30. Furthermore, the operation device 10 and the wiring device 20 may be provided with speed sensors (or acceleration sensors) that detect the speed (or acceleration) of the movable parts of the mechanisms of the operation device 10 and the wiring device 20 (e.g., output shafts of the actuators 12a and 22a) instead of the position sensors 13a and 23a, and the speed (or acceleration) of the movable parts of the mechanisms detected by the speed sensors (or acceleration sensors) may be transmitted to the control device 30.

[0113] According to the control algorithm of this modified example, a control method for following a virtual object is used, so that the reproducibility and operability of the operation of the operation device 10 and the wiring device 20 can be achieved with performance equal to or better than that of the conventional devices. Therefore, it is possible to realize more appropriate physical interaction with the robot. Also, although it is common to the control algorithm described with reference to FIG. 14, when the operating device 10 and the wiring device 20 are controlled by the above-mentioned control algorithm, the parameters required for control are reduced, and therefore the amount of data transmitted and received between the devices can be reduced.

[0114] [Variation 2] In the above-described embodiment, the operation device 10 and the control device 30 are realized as different devices. However, the present invention is not limited to this, and for example, the operation device 10 and the control device 30 may be realized as an integrated device. That is, the operation device 10 and the control device 30 may be realized as an integrated device that can accept the connection of the user U and control the transmission of haptics between the operation device 10 and the connection device 20. In this case, a function block for operation control that realizes a function equivalent to that of the control device 30 is inserted between the communication unit 14 and the driver 11a in the block diagram of FIG. 2. In addition, the detection value of the position sensor 13a is input to this function block for operation control, not to the communication unit 14. Then, this function block for operation control realizes the transmission of haptics between the connection device 20 based on a control algorithm similar to that of the control device 30 described above. Alternatively, the wiring device 20 and the control device 30 may be realized as an integrated device. That is, the device may receive the wiring of the user U via the operation device 10 and control the transmission of haptics between the operation device 10 and the wiring device 20. In this case, a functional block for operation control that realizes a function equivalent to that of the control device 30 is inserted between the communication unit 24 and the driver 21a in the block diagram of FIG. 2. Also, the detection value of the position sensor 23a is input to this functional block for operation control, not to the communication unit 24. Then, this functional block for operation control realizes the transmission of haptics between the operation device 10 and the control device 10 based on a control algorithm similar to that of the control device 30 described above. Alternatively, the control of the transmission of such haptics may be distributed between the operating device 10 and the wiring device 20. In this case, a functional block for operation control is added to each device. Then, the functional block for operation control of each device acquires detection values ​​from the sensor of its own device and detection values ​​from the sensor of the other device, and outputs command values ​​to the driver of its own device based on a control algorithm similar to that of the control device 30 described above. In this way, the transmission of haptics between other devices may be realized.

[0115] [Variation 3] In the above-described embodiment, the user U, who is an operator, instructs the wire connection mechanism 26 as shown in FIG. 3 to capture the leg wire W with the hook mechanisms 208L, 208R, and then operates the operating device 10 to cause the wire connection mechanism 26 to perform a gripping operation, etc., and proceeds with some of the steps of the wire connection work by instructing the user U, but this is not limited to the above. For example, a sensor may be provided to detect when the leg wires W are caught by the hook mechanisms 208L, 208R, and when the sensor detects that the leg wires W are caught by the hook mechanisms 208L, 208R, the upper gripping members 210L, 210R may automatically perform the gripping operation. Similarly, the operation of twisting two leg wires W by the torsional rotation unit T can be automatically performed by detecting with a sensor that the coverings of the two leg wires W have been stripped and the leg wires W are gripped. This makes it possible to automate the wiring work of the leg wires W to a higher degree.

[0116] [Variation 4] In the above embodiment, a configuration example in which the hook mechanisms 208L and 208R are provided to capture the leg wire W has been described, but the present invention is not limited to this. For example, instead of a configuration such as the hook mechanisms 208L, 208R that captures the leg wire W using an arm portion K1 and a hook-shaped member K2, it is also possible to configure a mechanism that includes an opening and closing mechanism (e.g., a scissors, tweezers or forceps-type mechanism) that opens and closes a pair of movable members, and an actuator that opens and closes the pair of movable members. FIG. 18 is a schematic diagram (top view) showing a configuration example of a wire connection mechanism 26 having an opening / closing mechanism for capturing the leg wire W. As shown in FIG. 18, instead of the hook mechanisms 208L, 208R having an arm portion K1 and a hook-shaped member K2, an opening / closing mechanism can be provided in which a pair of movable members are rotatably installed via hinges and the movable members are rotated by an actuator. With this configuration, the opening width for capturing the leg wire W can be increased, making it easier to capture the leg wire W even in situations where the leg wire W moves significantly due to wind or other factors.

[0117] [Variation 5] In the above-described embodiment, a configuration example has been described in which the peeling members 214L, 214R cut the coating with the clamping portion G2 to peel the coating from the core material of the leg wire W, but the method of removing (peeling, etc.) the coating of the leg wire W is not limited to this. For example, the coating can be removed from the core material by dissolving it with heat or chemicals, thereby exposing the core material of the leg wire W. In this case, instead of the clamping portion G2 being provided with a cutting blade, the clamping portion G2 may be provided with a heating wire or a chemical application member or the like, thereby realizing the coating removal function.

[0118] [Configuration example] As described above, the remote wire connection system 1 according to this embodiment includes the wire connection device 20, the operation device 10, and the control device 30. The wire connection device 20 includes a wire connection mechanism 26 that connects a plurality of linear members (eg, leg wires W) and a movement mechanism 25 that moves the wire connection mechanism 26. The operation device 10 includes a first operation mechanism 15 and a second operation mechanism 16 that receive remote operation of the wire connection device 20, and an actuator 12a that applies a reaction force to the remote operation input to the first operation mechanism 15. The control device 30 controls the operation of the moving mechanism 25 in response to remote operation of the moving mechanism 25 input to the first operating mechanism 15, and also has an operation control unit 312 that controls the operation of the actuator 12a to apply a reaction force in response to a force applied to the moving mechanism 25. This allows the main steps of the wire connection work to be performed by remote control. Furthermore, the force applied to the wire connection mechanism 26 is transmitted to the user U via the first operation mechanism 15. Therefore, electrical connections can be made more appropriately while ensuring the safety of the worker.

[0119] The movement mechanism 25 moves the wire connection mechanism 26 three-dimensionally in response to a remote control input to the first operation mechanism 15. The operation control unit 312 causes the actuator 12a to output the force input to the wiring mechanism 26 in response to the movement as a reaction force against the remote control. This makes it possible to transmit a haptic sensation to the user U during remote operation of moving the wiring mechanism 26 to connect the linear members.

[0120] The operation control unit 312 allocates the force input to the wiring mechanism 26 in response to the movement to each of the operations in a plurality of directions in the remote control, and causes the actuator 12a to output the force. This makes it possible to accurately convey to the user U in which direction of movement of the wire connection mechanism 26 the force was input.

[0121] The linear member is a leg wire W of explosives installed at the face F. The operation control unit 312 causes the actuator 12a to output the force of the wire connection mechanism 26 contacting the face F as a reaction force against the remote control of the forward / backward direction in which the wire connection mechanism 26 approaches and moves away from the face F. This makes it possible to prevent the wire connection mechanism 26 from coming into contact with the face F with excessively strong force.

[0122] The wire connection mechanism 26 includes hook mechanisms 208L and 208R and a torsional rotation unit T. The hook mechanisms 208L and 208R are moved to the moving mechanism 25 to catch a linear member present in space. The peeling members 214L, 214R remove the covering portions of the linear members captured by the hook mechanisms 208L, 208R, leaving behind the core material, and the core material that was covered by the removed covering portions is exposed. The torsional rotation unit T electrically joins a plurality of linear members with exposed core materials. This allows the user U to feel haptic sensations while working on the process of capturing the linear member, and also allows the wiring mechanism 26 to perform the process of removing the coating on the linear member and electrically connecting it.

[0123] The second operating mechanism 16 receives remote operation for removing the coating from the linear member and for electrical connection. The operation control unit 312 instructs the wire connection mechanism 26 to execute a process for removing the coating and a process for electrical connection in response to remote operations for removing the coating of the linear members and for electrical connection. As a result, after capturing the linear member, the user U can decide to perform processing for removing the coating of the linear member and electrically joining the linear member.

[0124] The remote wiring system 1 further includes a physical quantity data acquisition unit 311. The physical quantity data acquisition unit 311 acquires first position data relating to the position of the moving mechanism 25 and second position data relating to the position of the first operating mechanism 15. The operation control unit 312 realizes operation control by controlling the moving mechanism 25 to output a position and force corresponding to the operation represented by the second position data based on the first position data and the second position data that serves as the reference for the operation of the moving mechanism 25, and by controlling the first operating mechanism 15 to output a position and force corresponding to the operation represented by the first position data based on the second position data and the first position data that serves as the reference for the operation of the first operating mechanism 15. This makes it possible to independently provide position (angle) control energy and force control energy, that is, to independently control position (angle) and force.

[0125] The remote wiring system 1 further includes a physical quantity data acquisition unit 311. The physical quantity data acquisition unit 311 acquires physical quantity data representing the operation of the movement mechanism 25 and physical quantity data representing the operation of the movable part of the first operation mechanism 15. The operation control unit 312 imagines a virtual object including the moving mechanism 25 and the first operation mechanism 15, and calculates command values ​​for making the moving mechanism 25 and the first operation mechanism 15 follow the behavior of the virtual object as a result of inputs to the moving mechanism 25 and the first operation mechanism 15 based on the physical quantity data acquired by the physical quantity data acquisition unit 311, and realizes control of the operation based on the calculated command values. This makes it possible to achieve sufficiently high reproducibility and operability of the mechanical impedance of the environment.

[0126] [Realization of functions through hardware and software] The function of executing the series of processes according to the above-mentioned embodiment can be realized by hardware, software, or a combination of these. In other words, it is sufficient that the function of executing the series of processes described above is realized in any of the remote wiring systems 1, and there is no particular limitation on how this function is realized.

[0127] For example, when the function of executing the above-mentioned series of processes is realized by a processor that executes arithmetic processing, the processor that executes this arithmetic processing includes not only processors that are composed of various types of processing devices alone, such as single processors, multiprocessors, and multicore processors, but also processors that combine these various types of processing devices with processing circuits such as ASICs (Application Specific Integrated Circuits) or FPGAs (Field-Programmable Gate Arrays).

[0128] Also, for example, when the function of executing the above-mentioned series of processes is realized by software, the program constituting the software is installed in a computer via a network or a recording medium. In this case, the computer may be a computer in which dedicated hardware is built in, or may be a general-purpose computer (e.g., general electronic devices such as general-purpose personal computers) capable of executing a predetermined function by installing a program. Also, the step of writing the program may include only processes performed chronologically according to the order, but may also include processes performed in parallel or individually. Also, the step of writing the program may be performed in any order within the scope of the gist of the present invention.

[0129] The recording medium on which such a program is recorded may be provided to the user by being distributed separately from the computer main body, or may be provided to the user in a state in which it is pre-installed in the computer main body. In this case, the storage medium distributed separately from the computer main body is, for example, a removable medium 40, which is composed of a magnetic disk (including a floppy disk), an optical disk, or a magneto-optical disk. The optical disk is, for example, a CD-ROM (Compact Disc-Read Only Memory), a DVD (Digital Versatile Disc), or a Blu-ray (registered trademark) Disc. The magneto-optical disk is, for example, an MD (Mini Disc). The recording medium provided to the user in a state in which it is pre-installed in the computer main body is, for example, a storage unit 37 on which the program is recorded, which is composed of an HDD (hard disk drive) or an SSD (Solid State Drive). [Explanation of symbols]

[0130] 1 Remote wiring system, 10 Operation device, 11a, 21a Driver, 12a, 22a Actuator, 13a, 23a Position sensor, 14, 24, 38 Communication unit, 15 First operation mechanism, 16 Second operation mechanism, 20 Wiring device, 25 Movement mechanism, 26 Wiring mechanism, 30 Control device, 31 Processor, 32 ROM, 33 RAM, 34 Bus, 35 Input unit, 36 Output unit, 37 Memory unit, 39 Drive, 40 Removable media, 201 Vertical support plate, 202 First horizontal support member, 203L, 203R Vertical shaft, 204L, 204R Vertical shaft gear, 205L, 205R Peeling actuator, 206L, 206R Peeling gear, 207L, 207R First bracket, 208L, 208R Hook mechanism, 209L, 209R Hook mechanism actuator, 210L, 210R Upper gripping member, 211L, 211R, 215L, 215R, 219L, 219R, 228L, 228R Advance / retreat actuator, 212L, 212R, 216L, 216R, 220L, 220R, 229L, 229R Opening / closing cam follower, 213L, 213R Second bracket, 214L, 214R Peeling member, 311 Physical quantity data acquisition unit, 312 Operation control unit, 313 Wiring instruction unit, 217L, 217R Third bracket, 218L, 218R Lower gripping member, 221 Second horizontal support member, 222 Torsional operation axis, 223 Torsional actuator, 224 Lifting actuator, 225 third horizontal support member, 226L, 226R fourth bracket, 227L, 227R excess length cutting member, 314 image data acquisition unit, 315 image presentation unit, 371 physical quantity data storage unit, 372 image data storage unit, A aerial work platform, C camera, D parent die, F face, H charging hole, W landing line, T torsional rotation unit, CS controlled system, FT force-speed allocation conversion block, FC ideal force source block, PC ideal speed (position) source block, IFT inverse conversion block

Claims

1. a connecting mechanism for connecting a plurality of linear members; a moving mechanism for moving the wire connection mechanism; A wire connection device comprising: an operation mechanism for receiving a remote operation of the wire connection device; A reaction force applying means for applying a reaction force to a remote operation input to the operation mechanism; An operating device comprising: an operation control means for controlling an operation of the moving mechanism in response to a remote operation of the moving mechanism input to the operation mechanism, and for controlling an operation of the reaction force application means to apply a reaction force in response to a force applied to the moving mechanism; A remote wiring system comprising:

2. the moving mechanism moves the wire connection mechanism three-dimensionally in response to a remote operation input to the operation mechanism, 2. The remote wire connection system according to claim 1, wherein the operation control means controls the reaction force application means to output a force input to the wire connection machine mechanism in response to the movement as a reaction force against the remote operation.

3. 3. The remote wiring system according to claim 1, wherein the operation control means assigns a force input to the wiring mechanism in response to movement to each of a plurality of directional operations in the remote operation and outputs the force to the reaction force applying means.

4. The linear member is a leg wire of an explosive installed at a tunnel face, The remote wiring system according to claim 1 or 2, characterized in that the operation control means outputs to the reaction force applying means the force with which the wiring mechanism abuts against the face as a reaction force against the remote operation of the wiring mechanism in the forward / backward direction, which is the direction in which the wiring mechanism approaches and moves away from the face.

5. The wire connection mechanism includes: a capture unit that captures the linear member present in space by being moved by the moving mechanism; a coating removal unit that removes a coating portion of the linear member captured by the capturing unit while leaving a core material thereon, and exposes the core material that was covered by the removed coating portion; a joining mechanism that electrically joins the plurality of linear members with the core material exposed; 3. The remote connection system according to claim 1, further comprising:

6. the operation mechanism receives a remote operation for removing the coating of the linear member and electrically connecting the linear member, 3. The remote wiring system according to claim 1, wherein the operation control means instructs the wiring mechanism to execute a process for removing the coating and a process for electrical connection in response to remote operations for removing the coating and electrically connecting the linear members.

7. a data acquisition means for acquiring first position data relating to a position of the moving mechanism and second position data relating to a position of the operating mechanism, 3. The remote connection system according to claim 1 or 2, wherein the operation control means realizes the control of the operation by controlling the moving mechanism so as to output a position and a force corresponding to the operation represented by the second position data, based on the first position data and the second position data that is a reference for the operation of the moving mechanism, and controlling the operation mechanism so as to output a position and a force corresponding to the operation represented by the first position data, based on the second position data and the first position data that is a reference for the operation of the operation mechanism.

8. a data acquisition means for acquiring physical quantity data representing a motion of the moving mechanism and physical quantity data representing a motion of a movable part of the operation mechanism, 3. The remote connection system according to claim 1, wherein the operation control means imagines a virtual object including the moving mechanism and the operating mechanism, calculates command values ​​for causing the moving mechanism and the operating mechanism to follow behaviors exhibited by the virtual object in response to inputs to the moving mechanism and the operating mechanism based on the data of the physical quantities acquired by the data acquisition means, and realizes control of the operation based on the calculated command values.

9. a connecting mechanism for connecting a plurality of linear members; a moving mechanism for moving the wire connection mechanism; A wire connection device comprising: an operation mechanism for receiving a remote operation of the wire connection device; A reaction force applying means for applying a reaction force to a remote operation input to the operation mechanism; An operating device comprising: A control device for controlling an operation of a remote wiring system including: A control device comprising: an operation control means for controlling the operation of the moving mechanism in response to a remote operation of the moving mechanism input to the operating mechanism, and for controlling the operation of the reaction force applying means to apply a reaction force in response to a force applied to the moving mechanism.

10. a connecting mechanism for connecting a plurality of linear members; a moving mechanism for moving the wire connection mechanism; A wire connection device comprising: an operation mechanism for receiving a remote operation of the wire connection device; A reaction force applying means for applying a reaction force to a remote operation input to the operation mechanism; An operating device comprising: A remote connection method performed by a remote connection system including: an operation control step of controlling an operation of the moving mechanism in response to a remote operation of the moving mechanism input to the operation mechanism, and controlling an operation of the reaction force application means to apply a reaction force in response to a force applied to the moving mechanism; A remote wiring method comprising:

11. a connection mechanism for connecting a plurality of linear members; a moving mechanism for moving the wire connection mechanism; A wire connection device comprising: an operation mechanism for receiving a remote operation of the wire connection device; A reaction force applying means for applying a reaction force to a remote operation input to the operation mechanism; An operating device comprising: A computer constituting a control device for controlling the operation of a remote wiring system including: A program characterized by realizing an operation control function that controls the operation of the drive mechanism in response to remote operation of the drive mechanism by the user input to the operation mechanism, and controls the operation of the operation mechanism to transmit the force applied to the drive mechanism to the user.

Citation Information

Patent Citations

  • Loading device of explosive and loading method

    JP2020003145A