INSTRUCTION SYSTEM OF REMOTE-CONTROL ROBOT

Abstract: An instruction system of a remote-control robot having a work manipulator. The system comprises an instruction manipulator for providing work instructions to the work manipulator; a solid geometrical model forming device for forming solid geometrical models of the work manipulator and work circumstances; a simulating device for operating the positions and attitude of the geometrical models according the information of motions of the instruction manipulator and information from various sensors of the work manipulator to simulate geometrical models, as well as driving the work manipulator according to the information from the instruction manipulator, etc.; and a graphic display for displaying motions of the geometrical models. The solid geometrical model forming device forms geometrical models of the work manipulator and work circumstances, the simulating device simulating actual working positions of the geometrical models, and the graphic display displaying the simulated geometrical models. After that, the work manipulator is driven according to the instruction information. Thus, an operator can give work instructions to the work manipulator through the instruction manipulator while monitoring, at a real time, motions of the geometrical models displayed on the graphic display.

Description: The present invention relates to a system for controlling a working apparatus disposed at a location remote from an operator, comprising: a) instructing control means operable by the operator to provide instruction control signals; b) detecting means for providing output detection signals representing the disposition and movement of the working apparatus and of adjacent objects with which the working apparatus may interact; c) computing means adjacent to the instructing control means for supplying operating signals according to the instruction control signals to control the working apparatus, and for forming from said detection signals geometrical models of the working apparatus and the adjacent objects, for calculating movement of said models in accordance with the instruction control signals and for repositioning said models in relative positions allowing for said movement; d) display means adjacent to the operator for displaying the geometrical models formed by said computing means; whereby the operator may input instructions into the instructing control means while monitoring the displayed geometrical models, the computing means then supplying operating signals to the working apparatus in accordance with the instructions. Such a system may be applicable to control an unmanned robot working at a remote location such as in space far from the earth, enabling an operator on the earth to operate the robot while monitoring the work of the robot on earth substantially in real time. Such a system is known from "Robot task-planning system based on product modelling", IEEE 1985 Compint-Computer Aided Technologies, September 1985. A further disclosure of interest is "La perception en téléopération" by B. Espiau published in Revue General de l'Electricité, November 1984, Paris. Recently, a requirement has arisen to provide a remote-control robot which can work unmanned in special work circumstances such as space. To realize such a remote-control robot, it is proposed to use a conventional instruction system such as of a master/slave (M/S) method shown in Fig. 1. In this figure, a picture of a work manipulator 101 in space is taken by a stereo camera 103. Images from the stereo camera 103 are displayed on a display 105. While monitoring the images on the display 105, an operator operates an instruction manipulator 107 to drive the work manipulator 101 via a servo controller 109. However, unlike when controlling the robot as a proximal position on earth, there is a dead time due to the communication delay between space and the earth. Therefore, a delay of one second or more results after the instruction manipulator 107 is operated to move the work manipulator 101 until motions of the work manipulator 101 are displayed on the display 105 on the earth. Therefore, the operator is forced to give instructions to the work manipulator 101 according to motions thereof which are based on instructions given one second before or more by the operator through the instruction manipulator 107. Thus the operator cannot perceive motions of the work manipulator 101 in real time. This may be very dangerous. In executing unmanned operations in special work circumstances such as space as shown in Fig. 1, the conventional instruction system of the M/S method cannot easily realize stable operation because of the communication delays between the robot in space and the earth. An object of the present invention is to provide a control system for a remote-control robot, which can mitigate the above-mentioned problems in operating the robot. Another object of the present invention is to provide a control system for a remote-control robot working in space, which enables an operator to give instructions to the robot while confirming , on the earth, the work of the robot in space substantially in real time. According to one aspect of the invention, the system initially defined is characterised by a reaction generating means for generating reaction against force applied by the operator to the instructing means, the computing means being arranged to supply driving signals to the reaction generating means when the geometrical models of the working apparatus and an adjacent object interfere with each other. According to another aspect of the invention, there is provided an instruction method for remotely controlling a working apparatus located at a location remote from an operator which comprises the steps of: (a) forming geometrical models of the working apparatus and adjacent objects on the basis of detection signals received from the remote location; (b) displaying the formed geometrical models; (c) forming and displaying the geometrical models at relative position according to instruction signals from an instructing portion to which an operator gives instructions while observing the displayed geometrical models; (d) storing the instruction signals from said instructing portion; (e) determining, after said step (d), whether or not the geometrical models formed in said step (c) of the working apparatus and adjacent objects interfere with each other, and, if they interfere with each other, generating reaction against force applied by the operator onto said instructing portion; (f) driving the working apparatus according to the stored instruction signals after the operator has completely given his instructions; and (g) detecting any mismatch between the adjacent objects and working apparatus driven in said step (f) and the geometrical models thereof formed in said step (c), and correcting any said mismatch. These and other objects, features and advantages of the present invention will become apparent from the following description of a preferred embodiment taken in conjunction with the accompanying drawings in which: Fig. 1 is a block diagram showing an instruction system of a remote-control robot according to a conventional M/S method; Fig. 2 is a block diagram showing an instruction system of a remote-control robot according to an embodiment of the present invention; Fig. 3 is a block diagram showing respective functions of a solid geometrical model forming device and a simulating device incorporated in a computer of the embodiment shown in Fig. 2; and Figs. 4a and 4b are flow charts showing operation sequences of the embodiment shown in Fig. 2. Fig. 2 is a block diagram showing a instruction system of a remote-control robot according to an embodiment of the present invention. An instruction system "A" is located on the earth to operate a work manipulator 9 disposed in work circumstances in space. The instruction system A comprises an instruction manipulator 1 used by an operator to input instructions: an image processor 7 for processing video signals from a stereo camera 17 which take pictures of the work manipulator 9 and its work circumstances; a computer 3 for supplying operation signals according to instruction data from the instruction manipulator 1 to a servo controller 11 to operate the work manipulator 9 and forming geometrical models of the work manipulator 9 and work circumstances according to the video signals from the image processor 7, detection signals from a sensor 15 fitted to the work manipulator 9 and the instruction signals from the instruction manipulator 1; and a graphic display 5 for displaying the geometrical models formed by the computer 3. The instruction manipulator 1 is provided with a motor 19 for generating reaction against force applied by the operator onto the instruction manipulator 1. If the formed geometrical models of the work manipulator and work circumstances interfere with each other, the computer 3 sends drive signals to the motor 19 to generate the reaction. As shown in Fig. 3, the work circumstances include related apparatuses such as the stereo camera 17, a work object 31 and an obstacle 33. Two arms are provided for the instruction manipulator 1 to give instructions to the work manipulator 9 having two arms. Motions of the arms are successively informed to the computer 3. The computer 3 which is an essential part of the present invention will be described. As shown in Fig. 3, the computer 3 comprises a solid geometrical model forming device 13 and a simulating device 21. The solid geometrical model forming device 13 has a primitive geometrical model forming function for forming geometrical models of the work manipulator and work circumstances according to video signals from the image processor 7; a geometrical model operating function for operating and forming geometrical models indicating the working conditions of the geometrical model of the work manipulator 9: a positional relation defining function for defining positional relations of the geometrical models of the work manipulator and work circumstances; an interference checking function for judging according to the defined positional relations of the geometrical models whether or not the geometrical models interfere with each other: geometrical model shifting and rotating functions for shifting and rotating the geometrical models; a displaying function for displaying the geometrical models on the graphic display 5; and a mismatch detecting function for detecting whether or not any mismatch exists between the actual work manipulator and work circumstances and the geometrical models thereof after the completion of work. The simulating device 21 has an instruction data receiving function for receiving instruction data inputted from the instruction manipulator 1; a displacement converting function for converting the inputted instruction data into displacement data of the geometrical models; an instruction manipulator driving function for driving the motor 19 to generate reaction against force applied by the operator onto the instruction manipulator 1 when the geometrical models interfere with each other; a work manipulator operation receiving function for receiving operating conditions of the work manipulator 9 transmitted from the sensor 15: a position measuring function for receiving video signals from the stereo camera 17 via the image processor 7; and a work manipulator driving function for driving the work manipulator 9 according to the instruction data. As shown in Fig. 2, the solid geometrical model forming device 13 comprises a first PROM 25 storing a first program, a central controlling portion 26 and an operating portion 27, while the simulating device 21 comprises a second PROM 29 storing a second program, the central controlling portion 26 and the operating portion 27. The functions of the solid geometrical model forming device 13 described in the above are realized by the operating portion 27 under the control of the central controlling portion 26 according to the first program stored in the first PROM 25, while the functions of the simulating and operating device 21 described in the above are realized by the operating portion 27 under the control of the central controlling portion 26 according to the second program stored in the second PROM 29. The computer 3 further comprises a RAM for executing operations of the operating portion 27. Although the first and second programs are processed by the sole operating portion 27 in this embodiment, they may be processed by separate two operating portions. Further, the solid geometrical model forming device 13 and the simulating device 21 may be constituted by separate two computers which are able to execute the functions of the device 13 and 21, respectively. The sequences of instructing the work manipulator 9 by the instruction system of the present invention will be described with reference to Fig. 4. In step 101, the position measuring function is executed according to the second program to measure conditions of the work manipulator 9 and work circumstances by using the stereo camera 17. In step 102, the base geometrical model forming function is executed by the solid geometrical model forming device 13 according to the first program stored in the first PROM 25 to prepare base shapes (circular cylinders, rectangles, etc.,) of the work manipulator 9 and work circumstances by using a three dimensional geometrical modeller according to the measurement of the step 101. In step 103, the geometrical model operating function is executed to operate (add or subtract) the base geometrical models to prepare original geometrical models of the work manipulator and work circumstances. In step 105, the positional relation defining function is executed to define positional relations of the original geometrical models of the work manipulator and work circumstances. In step 106, the geometrical model displaying function is executed according to the first program to display the original geometrical models on the graphic display 5. A preparatory stage will be accomplished with the steps 101 to 106. Then, an instruction stage will be started. The operator monitors the original geometrical models on the graphic display 5 and manipulates the instruction manipulator 1 to give necessary instructions. In step 107, the instruction data receiving function is executed according to the second program stored in the second PROM 29 to periodically input the motions of the instruction manipulator 1 via an angle detector 7 and receive them as instruction data. The displacement converting function is then executed to convert the instruction data into displacement quantities of the original geometrical models of the work manipulator and work circumstances. After that, the geometrical model shifting and rotating functions are executed according to the first program to prepare geometrical models based on the motions of the instruction manipulator 1. In step 108, the geometrical model displaying function is executed according to the first program to display the motions of the geometrical models corresponding to the motions of the instruction manipulator 1 on the display 5. At the same time, the displacement quantities mentioned in the above are stored as instruction data (step 109). In step 111, the interference checking function is executed according to the first program to judge whether or not the geometrical models of the work manipulator and work circumstances interfere with each other. If there is interference, the instruction manipulator driving function is executed according to the second program to drive the motor 19 To cause reaction on the instruction manipulator 1 to notify the operator of the occurrence of interference. In step 113, the geometrical model displaying function is executed according to the first program to again display the solid geometrical models of the work manipulator and work circumstances on the graphic display 5. In step 115, if the operator's instruction work is not completed, it proceeds to the step 107, and, if the instruction work is completed, it proceeds to step 117. In the step 117, the work manipulator driving function is executed according to the second program to send the instruction data stored previously to the work manipulator 9 via the servo controller 11 to drive the work manipulator 9. In step 119, the work manipulator operation receiving function and the position measuring function are executed according to the second program to measure, by using the stereo camera 17 and the sensor 15, actual conditions of the work manipulator 9 and work circumstances after they have been manipulated according to the instruction data. Then, the mismatch detecting function is executed according to the first program to detect whether or not there is any mismatch between the solid geometrical models and the actual conditions of the work manipulator and work circumstances after they have been manipulated. If there is a mismatch, the geometrical model shifting and rotating function is executed according to the first program to correct the solid geometrical models such that the geometrical models will match with the actual conditions of he work manipulator and work circumstances. In step 121, if the next instruction work is required, it proceeds to the step 107, and, if not, the instruction work is terminated. In summary, embodiments of the present invention can provide an instruction system in which a work manipulator and its work circumstances in space are related to geometrical models thereof on a graphic display on the earth, and motions of an instruction manipulator are displayed on the display at a real time. As a result, an operator may not sense delays in handling the work manipulator to easily carry out his instruction work. The instruction system for a remote-control robot can comprise: an instruction manipulator for providing work instructions to the remote-control robot having a work manipulator; a solid geometrical model forming device for forming solid geometrical models of the work manipulator and work circumstances; a simulating device for operating the positions and constitution of the geometrical models according the information of motions of the instruction manipulator and information from various sensors of the work manipulator to simulate geometrical models, as well as driving the work manipulator according to the information from the instruction manipulator, etc.; and a graphic display for displaying motions of the geometrical models. The solid geometrical model forming device prepares geometrical models of the work manipulator and work circumstances, the simulating device simulating actual working positions of the geometrical models, and the graphic display displaying the simulated geometrical models. After that, the work manipulator is driven according to the instruction information. Thus, an operator can give work instructions to the work manipulator through the instruction manipulator while monitoring, in real time, motions of geometrical models displayed on the graphic display. Therefore, the operator can give instructions to a robot in space as if the robot is located close to him.

Claims: A system for controlling a working apparatus disposed at a location remote from an operator, comprising: a) instructing control means (1) operable by the operator to provide instruction control signals; b) detecting means (17,7;15) for providing output detection signals representing the disposition and movement of the working apparatus (9) and of adjacent objects (31,33) with which the working apparatus (9) may interact; c) computing means (3) adjacent to the instructing control means (1) for supplying operating signals according to the instruction control signals to control the working apparatus (9), and for forming from said detection signals geometrical models of the working apparatus (9) and the adjacent objects (31,33), for calculating movement of said models in accordance with the instruction control signals and for repositioning said models in relative positions allowing for said movement; and d) display means (5) adjacent to the operator for displaying the geometrical models formed by said computing means; whereby the operator may input instructions into the instructing control means (1) while monitoring the displayed geometrical models, the computing means (3) then supplying operating signals to the working apparatus in accordance with the instructions, characterised by a reaction generating means (19) for generating reaction against force applied by the operator to the instructing means, the computing means (3) being arranged to supply driving signals to the reaction generating means when the geometrical models of the working apparatus (9) and an adjacent object (31,33) interfere with each other. A system as claimed in claim 1, characterized in that said computing means (3) includes a solid geometrical model forming means (13) and a simulating means (21) the solid geometrical model forming means (13) having a base geometrical model forming function for forming base geometrical models of the work apparatus and work circumstances according to the detection signals from said detecting means; a geometrical model operating function for forming geometrical models indicating the working conditions of the base geometrical model of the working apparatus by operating; a positional relation defining function for defining positional relations of the geometrical models of the working apparatus and work circumstances; an interference checking function for determining according to the defined positional relations of the geometrical models whether or not the geometrical models interfere with each other; geometrical model shifting and rotating functions for shifting and rotating the geometrical models; a geometrical model displaying function for displaying the geometrical models on said display means; and a mismatch detecting function for detecting whether or not any mismatch exists between the working apparatus and work circumstances and the geometrical models thereof after the completion of movements of the working apparatus according to the instruction signals, and the simulating means (21) having an instruction signal receiving function for receiving the instruction signals from said instructing portion; a displacement converting function for converting the inputted instruction signals into displacement data of the geometrical models; an instructing portion driving function for driving said reaction generating means to generate the reaction against force applied by the operator onto said instructing portion when the geometrical models interfere with each other; a working apparatus operation receiving function for receiving operating conditions of the working apparatus; a position measuring function for receiving the detection signals from said detecting means; and a working apparatus driving function for driving the working apparatus according to the instruction signals. A system as claimed in claim 2, characterised in that said computing means (3) comprises a first PROM (25) storing a first program, a second PROM (29) storing a second program, a central controlling portion (26) and an operating portion (27), the solid geometrical model forming means (13) being constituted by the first PROM (25) storing the first program, the central controlling portion (26) and the operating portion (27), the functions of the solid geometrical model forming means (13) being executed by the operating portion (27) under the control of the central controlling portion (26) according to the first program stored in the first PROM (25), the simulating means (21) being constituted by the second PROM (29) storing the second program, the central controlling portion (26) and the operating portion (27), the functions of the simulating means (21) being executed by the operating portion (27) under the control of the central controlling portion (26) according to the second program stored in the second PROM (29). A system as claimed in any preceding claim characterised in that the working apparatus comprises a work manipulator (9), and the instructing portion comprises an instruction manipulator (1). An instruction method for remotely controlling a working apparatus located at a location remote from an operator comprising the steps of: (a) forming geometrical models of the working apparatus and adjacent objects on the basis of detection signals received from the remote location; (b) displaying the formed geometrical models; (c) forming and displaying the geometrical models at relative positions according to instruction signals from an instructing portion to which an operator gives instructions while observing the displayed geometrical models; (d) storing the instruction signals from said instructing portion; (e) determining, after said step (d), whether or not the geometrical models formed in said step (c) of the working apparatus and adjacent objects interfere with each other, and, if they interfere with each other, generating reaction against force applied by the operator onto said instructing portion; (f) driving the working apparatus according to the stored instruction signals after the operator has completely given his instructions; and (g) detecting any mismatch between the adjacent objects and working apparatus driven in said step (f) and the geometrical models thereof formed in said step (c), and correcting any said mismatch.

Inventors: ASANO, KUNIJI, TSUCHIHASHI, TOSHIO 2-506 HIRADODOSO-APART, WAKAHARA, YASUSHI
Applicants: KABUSHIKI KAISHA TOSHIBA
Application year: 1988
Main classification: G05B19
IPC codes: G05B19, B25J3, B25J9