GUIDANCE SYSTEM FOR A MOBILE ROBOT

Abstract: The invention relates to a method for guiding a mobile object along a path within a predetermined environment and a guidance system. The system comprises first memory means (7) to store prediction patterns of objects within the environment, second memory means (8) to store an extrac­ tion sequence of the prediction patterns of the objects stored in said first memory means (7) and a control device (2) which compares for matching the prediction pattern obtained from said first and second memory means and a feature pattern obtained from an observed image, on the basis of positional information of the mobile object (1), and delivering a guidance signal thereto so as to diminish a difference between both patterns, when the pattern matching is possible.

Description: The present invention relates to a guidance system for a mobile robot and more particularly to a guidance system which can move a mobile robot to a destination in adaptation to an environment upon understanding the surrounding situation. Most of the robots presently operating are used in well-ordered environments such a factories. In the recent years, however, mobile robots usable also outside such well-ordered environments have been required. In order to fulfill that requirement the mobile robot needs to be given an autonomous moving function. An example of such a mobile robot is disclosed in an article by Moravec entitled "The Stanford Cart and The CMU Rover" and published on February 24, 1983. With that robot an image obtained by a television camera is processed to extract the feature points of the image, a three-dimensional object distribution involving a direction and a distance is calculated on the basis of the distribution of the feature points, and a distance to an object is found on the basis of the calculated result, whereupon a guidance signal is delivered to the mobile robot proper. In such image processing complicated calculations are necessary for the detection of the feature points and the extraction of the three-dimensional informaion. It has therefore been difficult to move the mobile robot at high speed and high precision. Further, EP-A 139 292 discloses a navigation apparatus for guiding a mobile system along a predetermined path which comprises detector means to detect a path movement of the mobile system, memory means to store predictive patterns relating to positional information of the mobile system, vision means to observe an actual environment and to detect an actual image thereof, image processing means to extract an observed feature pattern from the observed image obtained by said vision means, and guidance control means to compare the observed feature pattern from said image processing means and the predicted pattern delivered from said memory means in accordance with the positional information of the mobile system and to provide a guidance signal for the mobile system as an output. Additionally, US-A 4 164 728 discloses a correlation system which is to be used in an autolock follow apparatus in a guided missile arrangement and which employs correlating techniques on television or infra-red pictures of a scene obtained at different times. The said correlation is effected on the basis of line integrals of data relating to pictures of substantially the same scene obtained at different times such that a straightforward, linear processing technique can be used for the correlation. Specifically, in the said system a correlation arrangement is used which comprises storage means containing storage locations for storing data relating to first and second two-dimensional representations of substantially the same scene, selector means for selecting data from groups of said storage locations, each group containing data relating to a respective substantially linear region of one or other of said representations, means for individually combining the data selected from each group to produce respective combination signals, means for comparing pairs of combination signals relating to corresponding regions of the first and second representations to form respective comparison signals indicative of the degree of similarity between each compaired pair of combination signals, means for operating on the comparison signals to produce a correlation signal indicative of the extent to which said first and second representations resemble each other, means for effectively shifting the position of one of the representations relative to the other and for producing a respective correlation signal for each relative position adopted by said one representation in relation to the other, and means for selecting the correlation signal which indicates the closest resemblance of said first and second representaions to one another. Finally, GB-A 2 060 308 discloses a method of tracking a target by means of a tracking system comprising an image-producing sensor, a servo system to enable sensor follow-up of a target, and a correlation tracker. The said method comprises the steps of storing predetermined characteristics of a target in the correlation tracker, correlating an image produced by the sensor with the stored target characteristics until a threshold of similarity between the image and target characteristics is exceeded thereby to identify the presence of an image of the target in the sensor image, and storing the identified target image in the correlation tracker. It is an object of the present invention to provide a guidance system which, to guide a mobile robot in an arbitrary environment at high speed and at high precision, selectively applies the patterns of objects in the said environment as the guidance targets for the mobile robot to facilitate image processing. According to the present invention the said object is achieved by means of a guidance system defined in the appended claims. The essence of the present invention consists of a guidance system which enables performing the steps of comparing a feature pattern extracted from an actual observed image and the prediction pattern of an environmental object predicted in relation to the positional information of a mobile robot, finding the difference between both the patterns and then guiding and controlling the mobile robot so as to reduce the said difference, the selection sequence rule of the environmental objects serving as guidance targets being selected and applied by an operator and the prediction patterns for the guidance targets being created in accordance with the selection sequence rule of the objects. Thus, the comparisons between the prediction patterns of the objects according to the selection sequence rule selected and applied beforehand and the feature pattern from the observed image can be made quickly and accurately, so that the autonomous guidance of the mobile object can have the reliability enhanced more. BRIEF DESCRIPTION OF THE DRAWINGS: Fig. 1 is a diagram showing the arrangement of an embodiment of the system of the present invention; Fig. 2 is a view showing a room which is an example of the guidance space of a mobile object that is guided by the system of the present invention; Fig. 3 is an explanatory view showing the frame contents of the room shown in Fig. 2, which are stored in object memory means and object element memory means constituting the system of the present invention; and Fig. 4 is an explanatory diagram showing the principle of pattern matching which is employed in a movement control device constituting the system of the present invention. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS: Now, embodiments of the present invention will be described with reference to the drawings. Fig. 1 shows one embodiment of the system of the present invention. In this figure, numeral 1 designates a mobile robot, which is furnished with a vehicle mechanism 1A for running within a specified environmental region. The vehicle mechanism 1A of the mobile robot 1 is controlled by a movement control device 2, and the movement magnitude thereof is detected by a movement magnitude detector 3. A television camera 4 for imaging the surrounding environment is installed on the mobile robot 1. An image picked up by the television camera 4 is delivered to a display device 5, and also to feature pattern detection means 6. The feature pattern detection means 6 detects the feature pattern of the observed image. First memory means 7 stores the selection sequence rules of environmental objects. Second memory means 8 is constructed of object memory means 9 and object element memory means 10. The object memory means 9 stores the environmental objects on the basis of the so-called frame theory. For example, as regards a room shown in Fig. 2, the object memory means 9 stores the frame of the room, the frame of a floor, the frame of a wall, etc. hierarchically as illustrated in Fig. 3. In association with the object memory means 9, the object element memory means 10 stores object elements, for example, the height, depth and width of an obstacle for the frame of the obstacle as illustrated in Fig. 3. The object memory means 9 mentioned above delivers the list of the environmental objects to the display device 5. An input device 11 is manipulated by an operator so as to select and apply the selection sequence rule of the environmental objects which serve as the guidance targets of the mobile object. Prediction pattern generation means 12 reads out the information items of the selected object within the environmental region and the elements thereof from the object memory means 9 and the object element memory means 10 respectively and finds the prediction pattern of the object on the basis of the positional information of the mobile robot received from the movement magnitude detector 3, and it delivers the prediction pattern to the display device 5 and the movement control device 2. The movement control device 2 comprises pattern matching decision means 20 to decide the propriety of the matching between the feature pattern from the feature pattern detection means 6 and the prediction pattern from the prediction pattern generation means 12 and to deliver an "mismatch" signal to the display device 5 when the matching is improper, potential field calculation means 21 to respond to a "match" signal from the pattern matching decision means 20 to calculate the field of a potential  A acting between the prediction pattern and the feature pattern, for the purpose of controlling the vehicle mechanism 1A of the mobile robot 1 so as to diminish the deviation of both the patterns, and action force calculation means 22 to calculate the gradient vector of the force of action F B of the feature pattern on the prediction pattern as established by the field of the potential  A and to deliver the gradient vector as a guidance signal. Next, the interaction Φ AB between the aforementioned patterns will be described. Hereunder, in order to simplify the description, it is assumed that a space S be a screen as shown in Fig. 4 and that patterns A and B be binary images. Here, it is assumed that the pattern A be a pattern based on an observed image, while the pattern B be a pattern based on a predicted image created with an environment model K. Now, when the pattern A has been given, an adaptation law for bringing the position of the pattern B close to the pattern A needs to be found out. This adaptation law is obtained by introducing the potential  A which is produced on the space S by the pattern A. The potential  A can be evaluated according to the following equation (1): α A + X A = 0 (1) Here, α denotes a differential operator of δ x and δ y are parameters which denote the spacial extents of the potential  A . In addition, X A in Eq. (1) is a characteristic function in the case where the pattern A is regarded as the subset of the space S. Next, the action F B to which the pattern B is subjected by the field of the above-stated potential  A of the pattern A on the space S can be evaluated according to Eq. (2) given below. Here, in order to facilitate the description, only movements in x-axial and y-axial directions within a two-dimensional plane shall be handled. Here, X B is a characteristic function in the case where the pattern B is classed with the subset of the space S, and D denotes a gradient operator, namely, a differential operator of In accordance with Eqs. (1) and (2) mentioned above, it is possible to obtain information for transforming the pattern B relative to the pattern A, that is, the guidance information of the mobile robot. Since, however, Eq. (1) in this computation includes simultaneous equations of infinite dimensions, the use of the following approximation equation is favorable: The output U B of a manipulation mechanism M B for manipulating and moving the pattern B to the pattern A by the use of the solution of the potential  A in Eq. (3) given above can be evaluated according to the following equation (4): Next, the operation of the foregoing embodiment of the system of the present invention will be described. Prior to the initiation of the guidance of the mobile robot 1, the observed image from the television camera 4, the object list from the object memory means 9 and the prediction pattern from the prediction pattern generation means 12 are displayed on the display device 5. Meanwhile, the feature pattern detection means 6 detects the feature pattern from the observed image and delivers it to the pattern matching means 20. In addition, the prediction pattern generation means 12 delivers the prediction pattern to the pattern matching means 20 on the basis of the movement magnitude from the movement magnitude detector 3. The pattern matching means 20 delivers the "mismatch" signal to the display device 5 when the matching between both the patterns is impossible. Subsequently, on the basis of the "pattern mismatch" display indicated on the display device 5, the operator applies the selection sequence rule of the information items of the objects serving as the guidance targets of the mobile robot 1, to the first memory means 7 by the use of the input device 11 by referring to the observed image, the object list from the object memory means 9 and the prediction pattern from the prediction pattern generation means 12 which are indicated on the display device 5. Upon completion of this selection, the prediction pattern generation means 12 reads out the distribution and configuration data of the object from the object memory means 9 and the object element memory means 10 respectively in accordance with the selected rule and evaluates the prediction pattern of the object. This prediction pattern is applied to the display device 5. Thus, when the operator has judged the prediction pattern improper by referring to the observed image and the prediction pattern displayed on the display device 5, he/she manipulates the input device 11 so as to obtain the prediction pattern of another object from the object memory means 9 and to indicate it on the display device 5. When this prediction pattern has been judged proper, it is applied to the movement control device 2 through operator's manipulation of the input device 11. The movement control device 2 is also supplied with the feature pattern of the observed image from the feature pattern detection means 6. In consequence, the movement control device 2 compares the feature pattern with the prediction pattern and supplies the vehicle mechanism 1A of the mobile robot 1 with the guidance signal for guiding the mobile robot 1. Thus, the mobile robot 1 is guided and controlled to a target spot. As described above, the operator can apply the selection sequence rule of environmental objects with the input device 11 and select the prediction pattern of an object element corresponding to a certain object element in a feature pattern. In this way, the matching between the feature pattern and the prediction pattern is appropriately performed, so that the mobile robot can be guided at high speed and at high precision. While, in the foregoing, the mobile robot has been described by way of example, the invention is not restricted thereto. As thus far described, according to the present invention, a prediction pattern to be compared with the feature pattern of an observed image can be applied and set by selecting a rule, so that a very long time is not required for image processing as in the prior art. Therefore, a mobile object can be guided at high speed and at high precision.

Claims: A guidance system for a mobile robot (1) having a vehicle mechanism (1A) for running within a specified environmental region, comprising first memory means (7) for storing selection sequence rules of environmental objects, second memory means (8) for storing data on environmental objects and their distribution, prediction pattern generation means (12) which receives data on an environmental object selected from said second memory means (8) based on said selection rules in said first memory means (7) and associated positional information on the mobile robot (1) and evaluates a prediction pattern of the said associated object on the basis of said positional information on the mobile robot (1), image input means (4) for initiating a pickup of an image of the environment, feature pattern detection means (6) for extracting a feature pattern from the image applied thereto by said image input means (4), a control device (2) comparing said prediction pattern from said prediction pattern generation means (12) and said feature pattern from said feature pattern detection means (6) and delivering either a guidance signal for the mobile robot (1) so as to diminish a difference between the two patterns or a mismatch signal indicating that matching of the said two patterns is not possible, a display device (5) responding to a mismatch signal from said control device (2) by displaying said signal and an image of an environmental object and the pattern delivered by said prediction pattern generation means (12) based on the data of an environmental object stored in said first memory means (7) associated with positional information on the mobile robot (1) and selected by said extraction sequence from said second memory means (8), and input means (11) for commanding said second memory means (8) to activate said extraction sequence to select data on an object in said first memory means (7), to send said data to said prediction pattern generation means (12) and to display said prediction pattern delivered by said prediction pattern generation means (12) with the displayed object image delivered from said image input means (4) upon display of the mismatch signal on said display device (5). A system according to claim 1, wherein said second memory means (8) comprises object memory means (9) to store prediction patterns for said environmental objects hierarchically and object element memory means (10) to store geometrical data of said environmental objects. A system according to claim 2, wherein said second memory means (8) delivers a plurality of prediction patterns to said display device (5) on the basis of a selection command from said input means (11). A system according to claim 2, wherein said second memory means (8) delivers one prediction pattern to said display device (5) on the basis of a selection command from said input menas (11).

Inventors: KAMEJIMA, KOHJI, OGAWA, YURIKO
Applicants: HITACHI, LTD.
Application year: 1986
Main classification: G05D1
IPC codes: H04N7, G05D1