ROBOT CONTROL DEVICE, METHOD, AND PROGRAM

The robot control device enhances mobile robot efficiency by detecting and responding to obstacles with targeted actions, maintaining operation despite path blockages.

JP7595900B2Active Publication Date: 2024-12-09TOKYO ROBOTICS INC
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
JP2020080586
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2020-04-30
Publication Date
2024-12-09
Estimated Expiration
2040-04-30

AI Technical Summary

Technical Problem

Mobile robots face decreased work efficiency when obstacles, including people, block their movement paths, as existing systems fail to effectively manage such interruptions.

Method used

A robot control device that includes a movement path generator, obstacle detector, and response manager to selectively handle obstacles based on their nature, employing facial direction and audio notifications to guide people or objects away from the path.

Benefits of technology

The system maintains work efficiency by proactively addressing obstacles, ensuring the mobile robot can navigate around or remove them, minimizing disruptions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007595900000001
    Figure 0007595900000001
  • Figure 0007595900000002
    Figure 0007595900000002
  • Figure 0007595900000003
    Figure 0007595900000003
Patent Text Reader

Abstract

To provide a robot control device or the like which does not deteriorate working efficiency even when there is an obstacle on a moving route.SOLUTION: A robot control device includes: a moving route generation section which generates a moving route from a present place up to a destination; a moving control section which moves a moving robot along the generated moving route; an obstacle detection section which detects an obstacle on the moving route within a prescribed distance; an obstacle corresponding section which executes prescribed correspondences so as to remove the obstacle from the moving route. The obstacle detection section detects whether or not the obstacle is a person. The obstacle corresponding section executes one or a plurality of the prescribed correspondences selected according to whether or not the obstacle is the person.SELECTED DRAWING: Figure 2
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to, for example, a control device for a robot. [Background technology]

[0002] In recent years, robots have been applied to various places, not only factories and warehouses, but also commercial buildings, airports, nursing homes, etc. For example, Patent Document 1 discloses a collaborative mobile robot that autonomously navigates in a work area shared with humans in a factory. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Patent No. 6412179 Summary of the Invention [Problem to be solved by the invention]

[0004] However, when a mobile robot moves along a planned route to a destination, an obstacle may block the route. The mobile robot of Patent Document 1 is configured to detect the force applied at the time of contact and stop the movement of the mobile robot when it comes into contact with an obstacle blocking the route.

[0005] If there is an obstacle in the path of such a mobile robot, the path cannot be secured until people nearby notice the obstacle and remove it, which results in reduced work efficiency.

[0006] The present invention has been made to solve the above-mentioned technical problems, and an object of the present invention is to provide a robot control device etc. that does not reduce work efficiency even when an obstacle is present on the movement path. [Means for solving the problem]

[0007] The above-mentioned technical problems can be solved by a robot control device or the like having the following configuration.

[0008] In other words, the robot control device of the present invention is a robot control device that controls a mobile robot, and is equipped with a travel path generation unit that generates a travel path from a current location to a destination, a travel control unit that moves the mobile robot along the generated travel path, an obstacle detection unit that detects obstacles on the travel path within a predetermined distance, and an obstacle response unit that executes a predetermined response to remove the obstacle from the travel path, wherein the obstacle detection unit detects whether the obstacle is a human or not, and the obstacle response unit executes one or more of the predetermined responses selected depending on whether the obstacle is a human or not.

[0009] According to this configuration, when an obstacle is detected on the moving path, the predetermined action to be taken to remove the obstacle from the moving path can be selected depending on whether the obstacle is a person or not, so that a more appropriate action can be selected depending on the obstacle, and the obstacle can be efficiently removed from the moving path. This makes it possible to suppress a decrease in the work efficiency of the mobile robot even when an obstacle is detected on the moving path. In addition, since it is possible to execute a combination of multiple predetermined actions described below, it is possible to realize more detailed and diverse actions, and to remove the obstacle more efficiently.

[0010] The mobile robot may further include a head with a face facing forward and a drive means for driving the head, and if the detected obstacle is a person, the obstacle detection unit may detect the position of the person's head, and the obstacle response unit may control the drive means to turn the face toward the person's head as the predetermined response.

[0011] According to this configuration, if the obstacle is a person, the face portion is directed toward the head of the person, so that the person can be actively encouraged to move away from the travel route.

[0012] The obstacle response unit may further include an identification unit that identifies the person closest to the mobile robot when the detected obstacle is a person and there are multiple such people, and when the specified response is to turn the face unit toward the head of the person, the obstacle response unit may turn the face unit toward the head of the person identified by the identification unit.

[0013] With this configuration, even if multiple people are detected as obstacles, the people identified in the same order as human behavior can be prompted to evacuate sequentially and without any discomfort.

[0014] The mobile robot may further include a head with a face facing forward and a drive means for driving the head, and if the detected obstacle is not a person, the obstacle detection unit may detect the position of the head of a person in the vicinity of the mobile robot, and the obstacle response unit may control the drive means to turn the face toward the head of the person in the vicinity as the predetermined response.

[0015] According to this configuration, when the obstacle is an object, the face is directed toward the heads of people nearby, so that the person nearby can be actively encouraged to remove the obstacle from the travel path.

[0016] The predetermined response may further include a notification means for making a predetermined notification.

[0017] According to such a configuration, the notification means can be used to more clearly appeal to people in the vicinity to remove the obstacle from the travel route.

[0018] The mobile robot may further include a speaker as the alarm means, and the obstacle response unit may output, as the predetermined response, a predetermined sound selected depending on whether the obstacle is a person or not, using the speaker.

[0019] According to this configuration, the speaker can be used to appeal to the human sense of hearing, so that the user can be more strongly and clearly informed to remove the obstacle from the travel path. In addition, the sound to be output is selected depending on whether the obstacle is a person or not, so that the more appropriate sound can be selected to efficiently remove the obstacle from the travel path.

[0020] The predetermined sound may include a plurality of types of sounds having different strengths of influence, and the obstacle response unit may change the type of the predetermined sound at predetermined time intervals so that the strength of the influence increases.

[0021] According to this configuration, the strength of the prompt can be gradually increased, so that the prompt can be given at an appropriate strength that gradually increases according to the person's behavior, without making the person feel uncomfortable by suddenly uttering harsh words.

[0022] The obstacle response unit may increase a volume of the predetermined sound at predetermined time intervals.

[0023] With this configuration, it is possible to provide an appropriate approach by gradually increasing the volume of the sound depending on the person's actions, without startling the person with a sudden loud sound.

[0024] At least one of the type, volume, number of times of output, and duration of output of the predetermined sound output by the obstacle response unit may be configured to be able to be set in advance.

[0025] With this configuration, it is possible to set appropriate sounds according to the location where the mobile robot is to be used.

[0026] The speaker may be positioned so that the predetermined sound is output from the head.

[0027] With this configuration, a specific sound can be output from approximately the same position as a person, so the sound can be transmitted more effectively without causing discomfort to the person listening to the sound.

[0028] The obstacle response unit may change the strength of the action by the notification means at predetermined time intervals.

[0029] According to such a configuration, the notification means can provide an appropriate level of stimulation that gradually increases in strength in response to the person's actions.

[0030] The travel route generation unit may, when an obstacle is detected, generate a travel route from a current location to reach the destination while avoiding the obstacle, and the obstacle response unit may execute the predetermined response when a travel route from a current location to reach the destination while avoiding the obstacle cannot be generated.

[0031] With this configuration, if an obstacle is detected on the movement path, a movement path that avoids the obstacle and can reach the destination is regenerated, and if such a path cannot be regenerated, a predetermined response is taken to remove the obstacle from the movement path, so that the mobile robot can actively secure a movement path to the destination, thereby improving work efficiency.

[0032] The travel route generation unit may generate a travel route that avoids the obstacle from the current location and reaches the destination when the obstacle is detected and the obstacle is not removed from the travel route even after a predetermined time has elapsed since the obstacle response unit performed the predetermined response.

[0033] According to this configuration, when an obstacle is detected on the movement path, a predetermined action is taken to remove the obstacle from the movement path, and if the obstacle is not removed from the movement path even after a predetermined time has elapsed, a movement path that avoids the obstacle and can reach the destination is regenerated, so that the mobile robot can actively secure a movement path to the destination, thereby improving work efficiency.

[0034] The movement control unit may be configured to slow down or stop the mobile robot when the obstacle is detected during movement.

[0035] According to such a configuration, it is possible to safely reset the travel route or take a predetermined action against the obstacle before contacting or colliding with the obstacle.

[0036] The obstacle response unit may be configured to, when the mobile robot is stopped upon detection of the obstacle, maintain the stopped state of the mobile robot as the predetermined response.

[0037] According to such a configuration, it is possible to provide a mobile robot that can cope with a situation in which it is desired to operate the mobile robot quietly even if it means stopping its work.

[0038] The mobile robot may further include one or more arms having a manipulator mechanism.

[0039] With this configuration, it is possible to realize a mobile manipulator equipped with the above-mentioned functions.

[0040] When the detected obstacle is not a person, the obstacle response unit may point to the obstacle using the arm as the predetermined response.

[0041] With this configuration, it is possible to more accurately inform people nearby of obstacles that should be removed from the travel route.

[0042] The present invention can also be conceived as a method. That is, the robot control method according to the present invention is a robot control method for controlling a mobile robot, and includes a movement path generating step of generating a movement path from a current location to a destination, a movement control step of moving the mobile robot along the generated movement path, an obstacle detection step of detecting an obstacle on the movement path, and an obstacle response step of executing a predetermined response to remove the obstacle from the movement path, in which the obstacle detection step detects whether the obstacle is a person or not, and the obstacle response step executes one or more of the predetermined responses selected depending on whether the obstacle is a person or not.

[0043] The present invention can also be conceived as a computer program. That is, a robot control program according to the present invention is a robot control program for controlling a mobile robot, and includes a movement path generating step of generating a movement path from a current location to a destination, a movement control step of moving the mobile robot along the generated movement path, an obstacle detection step of detecting an obstacle on the movement path, and an obstacle response step of executing a predetermined response to remove the obstacle from the movement path, in which the obstacle detection step detects whether the obstacle is a person or not, and the obstacle response step executes one or more of the predetermined responses selected depending on whether the obstacle is a person or not. Effect of the Invention

[0044] According to the present invention, it is possible to provide a robot control device etc. that does not reduce work efficiency even when an obstacle is present on the movement path. [Brief description of the drawings]

[0045] [Figure 1] FIG. 1 is a schematic diagram of a mobile robot to which a robot control device is applied. [Diagram 2] FIG. 2 is a schematic diagram showing the external appearance of the mobile robot. [Diagram 3] FIG. 3 is a diagram illustrating the head of the mobile robot. [Figure 4] FIG. 4 is a flowchart illustrating the movement control. [Diagram 5] FIG. 5 is a flowchart illustrating the movement process. [Figure 6] FIG. 6 is a diagram for explaining a method for detecting an obstacle on a moving path. [Figure 7] FIG. 7 is a flowchart illustrating the obstacle handling process. [Figure 8] FIG. 8 is a diagram illustrating the person identification process. [Figure 9] FIG. 9 is a diagram for explaining the operation of the human response process. [Figure 10] FIG. 10 is a diagram for explaining the operation of the object correspondence processing. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0046] [Embodiment] 1 to 3 are diagrams for explaining the configuration of a mobile robot 100 to which a robot control device (controller 1) according to one embodiment of the present invention is applied. The mobile robot 100 is a robot that is expected to move within a working area shared with humans, and may be applied, for example, to a mobile manipulator having a function of picking up parts in a factory and transporting them to a predetermined location, or a service robot that guides travelers in facilities such as an airport. In this embodiment, an example will be described in which the mobile robot 100 is applied to a substantially human-shaped mobile manipulator equipped with a head 30 and an arm 40 having a manipulator mechanism as shown in FIG. 2.

[0047] As shown in FIG. 1, the mobile robot 100 of this embodiment includes a controller 1 that functions as a robot control device that controls the operation of the mobile robot 100, a movement mechanism driving means 2, a head driving means 3, a detection means 4, and an alarm means 5.

[0048] The controller 1 has functional units such as a moving path generating unit 11, a moving control unit 12, an obstacle detecting unit 13, and an obstacle corresponding unit 14. The controller 1 is an information processing device configured by connecting, for example, a central processing unit (CPU) as a processor, a read-only memory (ROM) and a random access memory (RAM) as storage media, an input / output interface (I / O interface), and the like via a bus. In addition, the ROM included in the controller 1 stores a program (control program) for executing each function of each of the above-mentioned functional units. That is, the controller 1 is configured to realize the functions of each of the functional units of the moving path generating unit 11, the moving control unit 12, the obstacle detecting unit 13, and the obstacle corresponding unit 14 by executing various programs stored in the storage medium. Note that the above-mentioned configurations of the processor and storage medium constituting the controller 1 are examples, and in addition to or instead of these, a GPU, a flash memory, a hard disk, a storage, and the like may be included. In addition, the functions of each of the above-mentioned functional units do not necessarily have to be realized only by the controller 1, and may be realized by each of or in cooperation with a plurality of controllers appropriately selected for each functional unit. The function of each functional unit of the controller 1 will be described below.

[0049] The movement path generating unit 11 generates a path (movement path) along which the mobile robot 100 is to move. Specifically, the movement path generating unit 11 executes path planning to generate a path from a predetermined position to a destination based on map information (map data) of a working area. The generated path is set as the movement path of the mobile robot 100. The predetermined position here may be a predetermined position that has been determined in advance, or may be the current position of the mobile robot 100. There are no particular limitations on the specific method of path planning executed by the movement path generating unit 11, and any known method used in existing mobile robots such as mobile manipulators may be appropriately adopted.

[0050] The movement control unit 12 controls the movement mechanism driving means 2 to move the mobile robot 100 along the movement path generated by the movement path generating unit 11. In this way, the mobile robot 100 of this embodiment is configured as a so-called autonomous running type mobile robot that moves autonomously along the generated movement path. The movement mechanism driving means 2 will be described later with reference to FIG. 2.

[0051] The detection means 4 is a mobile robot 1 3A. The obstacles in this case include not only objects but also people. The detection means 4 may be used not only as a means for detecting obstacles, but also as a means for recognizing the surrounding environment of the mobile robot 100 so that the mobile robot 100 can travel autonomously. The detection means 4 includes at least one of a sensor (image sensor, lidar, laser scanner, etc.), a stereo camera, etc. The detection means 4 in this embodiment is composed of an image sensor, and the detection means 4 is also referred to as a sensor 4 below. The image sensor is a sensor having an image sensor that converts light detected through an optical system into an electric signal, and the type is not particularly limited. The sensor 4 is configured to be able to detect obstacles in the surrounding environment including at least the front, and may be provided, for example, in a part corresponding to the human eye configured in the face part 31 shown in FIG. 3A. In addition, a sensor 4 that can detect all directions, such as a so-called 360-degree camera, may be provided, for example, on the top of the head 30. The sensor 4 in this embodiment detects the position of obstacles present in the vicinity including at least the front of the mobile robot 100, and, if the obstacle is a person, image data capable of recognizing the position and posture of the person, and transmits the detection data (image data) to the controller 1 (obstacle detection unit 13).

[0052] The obstacle detection unit 13 detects obstacles on the movement path based on the detection data (image data) acquired by the sensor 4. The obstacle detection unit 13 also identifies whether the obstacle is a person, and if the obstacle is a person, detects the position and posture of the person. Furthermore, the obstacle detection unit 13 may be configured to detect not only obstacles on the movement path, but also the positions and postures of people present around the mobile robot 100. However, the obstacle detection unit 13 The posture of a person detected by the obstacle detection unit 13 does not necessarily have to be the posture of the entire body, but it is sufficient that at least the position of the person's head can be detected. Note that, while various known methods can be adopted as a method for detecting the position and posture of a person based on image data, in this embodiment, a method (bone model) for detecting the position and posture of a person by detecting the skeleton (bones) of the person from the image data may be adopted. This allows the obstacle detection unit 13 to easily detect the position of the head of a person on the moving path and around the mobile robot 100.

[0053] Furthermore, the "obstacle on the movement path" detected by the obstacle detection unit 13 may include an obstacle that may come into contact with or collide with when the mobile robot 100 moves along the movement path. In other words, the "movement path" here may be thought of not only as a simple line drawn corresponding to the planned path along which the mobile robot 100 is to move, but also as a band having a width corresponding to the horizontal width of the mobile robot 100. A specific example of a method for detecting an "obstacle on the movement path" will be described later with reference to FIG. 8.

[0054] When the obstacle detection unit 13 detects an obstacle, the obstacle response unit 14 executes a predetermined response to the obstacle. The predetermined response here includes, for example, driving the head 30, issuing a predetermined notification from the notification means 5, and the like. The predetermined response may be appropriately selected depending on the type of obstacle (e.g., whether or not it is a person) and the situation. Details of the predetermined response will be described later with reference to Figs. 9 and 10.

[0055] The head direction control unit 14a controls the head driving means 3 to drive the head 30 (see FIG. 2) provided in the mobile robot 100. Specifically, the head direction control unit 14a controls the direction in which the head 30 faces forward via the head driving means 3. Details of the head driving means 3 will be described later with reference to FIG. 2. The head direction control unit 14a in this embodiment will be described as one functional unit of the obstacle response unit 14.

[0056] The notification control unit 14b performs a predetermined notification using the notification means 5. In this embodiment, the notification means 5 is a speaker, and the notification means 5 will also be referred to as the speaker 5 below. That is, the notification control unit 14b outputs a predetermined sound using the speaker 5. Details of the predetermined sound will be described later. Note that the notification control unit 14b in this embodiment will be described as one functional unit of the obstacle response unit 14.

[0057] FIG. 2 is a diagram for explaining the configuration of the mobile robot 100, and mainly shows an example of the external appearance of the mobile robot 100. As shown in FIG.

[0058] As shown in the figure, the mobile robot 100 of this embodiment has a roughly humanoid shape and is composed of a robot main body unit 10, a mobile cart 20 that supports the robot main body unit 10, a head unit 30 provided at the upper end of the robot main body unit 10, and arms 40 extending from the front of the robot main body unit 10.

[0059] The mobile dolly 20 supporting the robot main body 10 mainly has a function of moving on the surface (floor surface) on which the mobile robot 100 is placed. The type of mobile dolly 20 is not particularly limited, but an omnidirectional mobile dolly is adopted in this embodiment. The omnidirectional mobile dolly is a dolly configured to be able to move in all directions, for example, by providing a plurality of omni wheels as driving wheels. As shown in FIG. 2, the mobile dolly 20 of this embodiment may be composed of three driving wheels 22 and a mobile mechanism driving means 2 for driving the driving wheels 22 via a belt or the like, inside a skirt 21 shown in the exterior. The mobile mechanism driving means 2 of this embodiment is composed of one or more motors, and hereinafter, the mobile mechanism driving means 2 is also referred to as the motor 2.

[0060] In the roughly humanoid mobile robot 100, the head 30 may be provided at the upper end of the robot main body 10 as a configuration equivalent to a human head (part above the neck). The head 30 is preferably configured so that a person can recognize its front as a face. The head 30 is configured so that the direction in which the front faces can be controlled. Specifically, the mobile robot 100 of this embodiment is equipped with one or more head driving means 3 (actuators 3), and is configured so that the direction of the front face can be controlled by moving the head via the head driving means 3. In the following, the front face of the head 30 is referred to as the face 31.

[0061] The mobile robot 100 of this embodiment has a head driving means 3 (servo motor 3a) that has a vertical rotation axis that rotates the head 30 in a horizontal direction (left and right direction) relative to the floor surface and enables the head 30 to be rotated left and right. This allows the mobile robot 100 to rotate only the head 30 left and right relative to the vertical direction. However, the arrangement of the servo motor 3a is not limited to the arrangement shown in the figure, and may be changed as appropriate as long as the orientation of the face 31 can be moved left and right. For example, the servo motor 3a may be provided at the lower end of the robot body 10 so as to rotate the robot body 10 left and right relative to the moving carriage 20. In this case, the servo motor 3a can change the orientation of the face 31 by rotating the head 30 together with the robot body 10 left and right relative to the vertical direction.

[0062] The mobile robot 100 may also have a head driving means 3 (servo motor 3b) that has a horizontal rotation axis for driving the head 30 in the vertical direction relative to the floor surface and enables the head 30 to look up and down. This allows the mobile robot 100 to move the face 31 in the vertical direction as well.

[0063] FIG. 3 is a diagram for more specifically explaining a configuration example of the head 30 of this embodiment. The shape of the head 30 is not particularly limited as long as the front side can be recognized as the face 31. For example, it is desirable that the face 31 has a structural feature that is visible only in the front part of the head 30 so that the front side can be easily recognized as the face 31. For example, as shown in FIG. 3(a), a configuration corresponding to two eyes imitating a human face is provided only in the front side of the head 30, so that the front side can be easily recognized as the face 31. Also, as shown in FIG. 3(b), a characteristic part (part indicated by a thick arrow) made of, for example, a transparent member may be provided only in the front side of the head 30. Alternatively, although not shown, only the front side of the head 30 having a substantially oval shape may be made flat, for example.

[0064] As shown in the figure, the head 30 may be provided on the robot body 10 via a structure (neck) corresponding to a human neck, or may be provided directly on the upper end of the robot body 10. That is, the servo motors 3a and 3b may be provided on the neck or on the head 30. The detection means 4 may be provided on the head 30 so as to detect the external environment, for example, from a portion corresponding to the eyes shown in FIG. 3(a) or a portion made of a transparent member shown in FIG. 3(b). The speaker 5 may be provided so as to output sound from the head 30, for example, the face 31. The above is an example of the configuration of the head 30. Returning to FIG. 2, the explanation will be continued.

[0065] As shown in Fig. 2, the mobile robot 100 of this embodiment has an arm 40 on the front side of the robot main body 10. The arm 40 has a manipulator mechanism, and a gripping mechanism 41 for gripping a member to be transported is provided at the tip corresponding to the free end. However, the shape, number, and arrangement of the arm 40 are not limited to the embodiment shown in the figure, and may be changed appropriately depending on the purpose. For example, the mobile robot 100 may be configured as a dual-arm robot having arms 40 on both sides of the robot main body 10.

[0066] The above is an example of the configuration of the mobile robot 100 of this embodiment. Note that the mobile robot 100 may also include other components necessary for controlling the operation of the mobile robot 100, such as other actuators for driving the arms 40, a battery serving as a power source, etc., which are omitted in Fig. 2.

[0067] Next, the operation of the mobile robot 100 will be described with reference to FIGS.

[0068] 4 is a flowchart for explaining the movement control performed by the mobile robot 100 of this embodiment. A control program for executing the processes described below with reference to the illustrated flowchart is stored in a storage medium provided in the controller 1.

[0069] In step S11, the controller 1 executes a task acquisition process. The task acquisition process is a process for acquiring information required for the mobile robot 100 to generate a movement path by a movement path generation process (S12) described later. In the task acquisition process, for example, identification information (part ID) of a part to be picked and location information (e.g., location coordinates) of a destination are acquired. There is no limitation on the acquisition method, and for example, the information may be acquired using a known wireless communication technology, or may be configured to be acquired via information input means (e.g., a touch panel, etc.) not shown.

[0070] In step S12, the controller 1 (movement path generating unit 11) generates a movement path from the current location to the destination. The destination may be set according to information acquired by the task acquisition process. For example, when a part ID is acquired by the task acquisition process, the movement path generating unit 11 sets the location where the part specified by the part ID is placed as the destination, and generates a path from the current location to the destination. The generated path is set as the movement path of the mobile robot 100. At that time, when multiple candidate paths are generated, a setting condition may be set in advance, such as prioritizing a path that can reach the destination the fastest or a path with the shortest distance to the destination. When the movement path to the destination is set, a movement process is executed to move the mobile robot 100 to the destination (S13).

[0071] In step S13, the controller 1 (movement control unit 12) executes a movement process for moving the mobile robot 100 to the destination. In the movement process, the movement control unit 12 controls the motor 2 to move the mobile robot 100 to the destination along a set movement path. The specific method of the movement process executed in this step is not particularly limited, and various known methods may be appropriately adopted. For example, the mobile robot 100 may be configured to realize autonomous movement (autonomous running) to the destination by controlling the motor 2 while performing known self-position estimation such as odometry and scan matching based on a path planned by path planning and map data of a working area stored in advance.

[0072] The movement process in step S13 will be described in detail with reference to FIG.

[0073] 5 is a flowchart for explaining the movement process performed by the mobile robot 100 of this embodiment. The movement process explained in this flowchart is executed continuously while the mobile robot 100 moves to the destination along the set movement route. Note that a control program for executing the process explained below with reference to the illustrated flowchart is stored in a storage medium provided in the controller 1.

[0074] In step S131, the controller 1 (obstacle detection unit 13) detects an obstacle on the movement path within a predetermined distance. A specific example of a method in which the obstacle detection unit 13 detects an obstacle on the movement path will be described with reference to FIG.

[0075] Fig. 6 is a diagram for explaining a method in which the obstacle detection unit 13 of this embodiment detects an obstacle on a movement path. Fig. 6 shows the mobile robot 100 and an obstacle 300 detected by the detection means 4. The dotted arrow extending from the mobile robot 100 indicates the generated movement path. The solid arrow extending from the mobile robot 100 indicates the most recent movement direction of the mobile robot 100 (movement direction from the current position), that is, the direction from the current position toward the point (waypoint) where the robot makes its first turn on the movement path.

[0076] The obstacle detection by the obstacle detection unit 13 of this embodiment may be performed by regarding the mobile robot 100 and the obstacle 300 as simple two-dimensional figures projected onto the floor surface from above, and judging whether or not the two-dimensional figures interfere with each other. As illustrated in FIG. 6, the mobile robot 100 is represented by a series of circles projected corresponding to each link of the mobile cart 20 and the arm unit 40, for example. The obstacle (person) 300 is represented by a circle taking into consideration the area that spreads horizontally when the arm is stretched horizontally. If the obstacle is not a person, it may be represented by a two-dimensional figure appropriately selected according to the outer shape of the obstacle. The outer edge of the projected two-dimensional figure, for example, the diameter of the circle, does not necessarily have to match the maximum horizontal width of the mobile robot 100 as viewed from above, and the maximum horizontal width of the obstacle 300, respectively. The projected two-dimensional figure may be appropriately adjusted, for example, by making it slightly wider to provide some margin, or by narrowing it in consideration of a realistic range of movement.

[0077] Moreover, a circle corresponding to the mobile robot 100 is generated along the moving path while the mobile robot 100 moves a predetermined distance or a predetermined time. In FIG. 6, circles corresponding to the mobile robot 100 moving within a predetermined distance indicated by a dotted circle are shown in time series. In this figure, the circle corresponding to the mobile robot 100 at the current location is (t), and the circles generated in time series along the moving path are shown as (t+1) and (t+2). Then, the obstacle detection unit 13 calculates whether or not the circle corresponding to the mobile robot 100 and the circle corresponding to the obstacle 300 contact (interfere) within the predetermined distance. Whether or not they contact can be easily calculated based on, for example, the center distance between the circles and the respective radii of each circle. As a result, the obstacle detection unit 13 can easily detect that the mobile robot 100 may come into contact with or collide with the obstacle 300 at (t+2), i.e., that the moving path is blocked by the obstacle 300 at the position (t+2), as shown in the figure.

[0078] The predetermined distance indicated by the dotted circle in the figure, i.e., the distance range in which an obstacle on the moving path is detected based on the current location, may be set as appropriate. The predetermined distance here is a distance set mainly with the intention of excluding detection of an obstacle located too far from the mobile robot 100, and may be set as appropriate according to the moving speed of the mobile robot 100 and the size of the working area, for example, 5 m. In the figure, an example is shown in which a range closer than the waypoint, i.e., an obstacle that the mobile robot 100 may collide with if it moves in the immediate moving direction, is detected, but this is not limited to this. The predetermined distance within which an obstacle is detected may be set as appropriate, and in principle may be set to a range beyond the waypoint within a range detectable by the detection means 4.

[0079] The collision determination method of generating a two-dimensional figure as the collision verification figure as described above is an example, and is not limited to this. The obstacle detection unit 13 may generate, for example, a band having a width corresponding to the horizontal width of the mobile robot 100 along the movement path as the collision verification figure. The obstacle detection unit 13 may also employ other known collision determination methods that generate three-dimensional figures. In this case, 100 and obstacle 300 may be represented by a series of three-dimensional spheres or a polygon mesh as a graphic for collision verification.

[0080] Returning to Fig. 5, the description will be continued. If no obstacle is detected on the travel route in the process of step S131 (determination of NO), the processes of steps S131 to S132 are repeatedly executed until the destination is reached. If an obstacle is detected on the travel route (determination of YES), the process of step S133 is executed.

[0081] In step S133, the controller 1 judges whether or not to generate another moving path that avoids the obstacle based on a previous setting. If it is previously set that the moving path is regenerated when an obstacle is detected (YES judgment), the process proceeds to step S134. If it is not previously set that the moving path is regenerated when an obstacle is detected (NO judgment), the process proceeds to obstacle handling processing in step S134. There is no limitation on the setting method for the regeneration of the moving path, and it may be set, for example, via a known wireless communication technology, or may be configured to be set via an information input means (for example, a touch panel, etc.) not shown. Also, the previous setting for the regeneration of the moving path may not be made. In this case, the process of step S133 may be deleted, and the controller 1 executes the process of step S134 when an obstacle is detected on the moving path (S131, YES judgment).

[0082] In step S134, the controller 1 (movement route generating unit 11) attempts to generate a movement route (avoidance route) that can reach the destination from the current location by avoiding the obstacle detected in step S131. At this time, an upper limit of the distance or time required to reach the destination may be set in advance as a generation condition of the avoidance route. For example, when a distance upper limit of 100 m is set, if an obstacle is detected on a passage to the destination and cannot be overcome by avoiding the obstacle in consideration of the width of the passage, and if the distance from the current location to the destination exceeds 100 m by the only detour, an avoidance route is not generated and a new movement route is not reset. Note that, similarly to the movement route generation process in step S12, when multiple candidate routes are generated, a condition may be set in advance such that a route that can reach the destination the fastest or a route that has the shortest distance to the destination is prioritized.

[0083] When the avoidance route is generated (S134, YES judgement), a movement route resetting process is executed to reset the generated avoidance route as a movement route (S135), and the processes from step S131 to step S132 are repeatedly executed along the reset movement route until the destination is reached. During that time, the mobile robot 100 moves along the movement route, and when it is judged that the destination has been reached (S132, YES judgement), the movement process ends.

[0084] On the other hand, if it is determined in step S134 that there is no route that can avoid the obstacle from the current location to the destination, or there is no route that satisfies the above-mentioned upper limit or set condition, and therefore an avoidance route cannot be generated (NO judgment in S134), the process proceeds to obstacle response processing in step S136 to execute a predetermined response to remove the obstacle.

[0085] In addition, from when an obstacle is detected in step S131 until the obstacle handling process (S136) or the movement route resetting process (S135) is executed, the controller 1 (movement control unit 1 2) may execute a process (deceleration process) for decelerating or stopping the movement of the mobile robot 100. This allows the obstacle handling process (S136) or the movement path resetting process (S135) to be safely executed before a collision with the obstacle when an obstacle is detected during movement. The degree of deceleration and the stopping position (distance from the obstacle) may be preset or may be appropriately adjusted according to the moving speed of the mobile robot 100 at the time when the obstacle is detected.

[0086] The above is the details of the movement processing performed by the mobile robot 100 of this embodiment. Next, the details of the obstacle handling processing will be described with reference to FIG.

[0087] 7 is a flowchart for explaining the obstacle handling process (S136) performed by the mobile robot 100 of this embodiment. A control program for executing the process described below with reference to the illustrated flowchart is stored in a storage medium provided in the controller 1.

[0088] In step S1361, the controller 1 (obstacle detection unit 13) judges whether the obstacle is a person or not. Whether the obstacle is a person or not can be easily judged by analyzing the detection data (image data) acquired by the detection means 4. The detection means 4 may be configured to detect infrared rays emitted from the obstacle in order to judge whether the obstacle is a person or not from the temperature of the obstacle. If the obstacle is a person (YES judgment), the process of step S1362 is executed to judge whether the number of detected obstacles (people) is multiple or not. If the obstacle is not a person (NO judgment), the process proceeds to step S1365 to execute object correspondence processing for obstacles that are not people. Details of the object correspondence processing will be described later with reference to FIG. 10.

[0089] In step S1362, the controller 1 determines whether or not multiple people have been detected. If only one person has been detected (NO determination), the process proceeds to step S1364 to execute a person response process for the detected person. Details of the person response process will be described later with reference to FIG. 9. On the other hand, if multiple people have been detected (YES determination), a person identification process (S1363) is executed to identify a target for which the person response process is to be executed. Details of the person identification process will be described with reference to FIG. 8.

[0090] Fig. 8 is a diagram for explaining the person identification process. Fig. 8 is a diagram showing the positional relationship between the mobile robot 100 and a person as viewed from above, and shows the mobile robot 100, a moving path indicated by a dotted arrow extending from the mobile robot 100, an immediate moving direction indicated by a solid arrow extending from the mobile robot 100, a predetermined distance from the mobile robot 100 indicated by a dotted circle, and multiple people including person A and person B.

[0091] Person A and person B shown in FIG. 8 are both people detected as obstacles on the movement path within a predetermined distance. In this way, when multiple people are detected as obstacles on the movement path within a predetermined distance, the controller 1 identifies the person who is predicted to come into contact with or collide with the mobile robot 100 first when the mobile robot 100 moves. Specifically, the person closest to the mobile robot 100 (person A) is identified as the person who is predicted to collide with first. However, the speed and direction of movement of the person may be taken into consideration when identifying the person who is predicted to collide with first. In this case, for example, if person A is detected as an obstacle on the movement path within a predetermined distance, the controller 1 identifies the person who is predicted to come into contact with or collide with the mobile robot 100 first. 1 00 while person B is moving away from the mobile robot. 1 00 quickly, person B may be identified as the first person predicted to collide with. When a target for performing human response processing is identified by the person identification processing, the human response processing of step S1364 is executed.

[0092] In step S1364, since it is determined that the obstacle is a person (YES determination in S1361), one or more predetermined responses selected when the target is a person are executed against the detected obstacle. A specific description will be given with reference to FIG.

[0093] 9 is a diagram for explaining the human response processing. The human response processing of this embodiment includes at least one of the following three responses. Specifically, the human response processing executes one of the following, or a combination of two or more of: stopping the movement of the mobile robot 100 (human response 1), turning the face unit 31 toward the person's head (human response 2), and outputting a predetermined sound (human response 3). The dotted arrows in the figure indicate the movement route of the mobile robot 100.

[0094] FIG. 9(a) is a diagram for explaining the mobile robot 100 performing either or both of human response 1 and human response 3. As shown in the figure, the mobile robot 100 may stop in front of a human who is an obstacle (human response 1). For example, when the mobile robot 100 stops in front of an obstacle by the above-mentioned deceleration process, the stopped state is maintained. This type of response gives priority to human actions, and in principle, the mobile robot 100 will quietly wait for the human to notice the presence of the mobile robot 100 and move out of the movement path.

[0095] Furthermore, the mobile robot 100 may output a predetermined sound through the speaker 5 in the state of FIG. 9(a) (human response 3). The predetermined sound may be a warning sound such as a buzzer sound, or a voice such as "Excuse me, please move out of the way" or "I'm moving." The type of the predetermined sound may be appropriately selected from a plurality of pre-stored patterns according to a prior setting, etc. Not only the type of sound, but also the volume, the number of times the sound is repeated (the number of times it is output), and the duration of the sound output, etc. may be configured to be pre-configurable. This allows the mobile robot 100 to output an appropriate sound according to the scene in which the mobile robot 100 is used and the request of the user who manages the mobile robot 100.

[0096] In addition, when a predetermined sound is output in combination with Stationary Person Response 1, the timing of output may be set appropriately. For example, the sound may be set to be output if the person does not move away even after a stationary state continues for 5 seconds.

[0097] The type, volume, and number of repetitions of the output sound may also be changed according to the duration of the human response process. For example, multiple types of sounds with different levels of influence according to the strength (meaning) of the words, such as "I'm sorry," "Please move," and "Get out of the way," may be prepared, and the type of sound to be output may be changed to stronger words at predetermined intervals so that the degree of influence gradually increases. Note that the predetermined time here may be set appropriately. Also, the time intervals when changing in stages do not need to be equal.

[0098] In addition to the type of sound, the volume of a predetermined sound may be gradually increased at predetermined time intervals. In this way, in human response 3, the strength of the encouragement (strength of the degree of encouragement) can be increased in stages by gradually increasing the volume or gradually increasing the type of sound (content of words). This allows the mobile robot 100 to encourage the person to evacuate with an appropriate strength that changes in stages according to the person's behavior, without making the person uncomfortable or startling them by suddenly uttering harsh words at a loud volume.

[0099] FIG. 9(b) is a diagram for explaining a state in which the mobile robot 100 is performing a response (human response 2) in which the face unit 31 faces the head of a person. As shown in the figure, the obstacle response unit 14 (head directionThe control unit 14a) may turn the face unit 31 toward the person's head as a human response process. This can encourage people on the movement path to evacuate more strongly than human response 1, which is stationary, and more softly than human response 3, which outputs a sound. It may be executed in combination with at least one of human response 1 and human response 3, and the combination timing may be set appropriately. For example, it may be configured to turn the face unit 31 toward the person's head after a predetermined time has elapsed from a stationary state, and to output a sound when a further predetermined time has elapsed. This makes it possible to perform more detailed actions depending on the situation. The above is the details of the human response process of this embodiment. When the obstacle is a person, the obstacle response unit 14 is configured to execute one or more predetermined responses selected from the above-mentioned human responses 1 to 3 for the person.

[0100] Next, details of the object corresponding process in step S1365 will be described with reference to FIG.

[0101] FIG. 10 is a diagram for explaining the object correspondence process. The object correspondence process is a process performed when it is determined that the obstacle is not a person (S1361, NO judgment), and includes at least one or both of the following two responses. Specifically, the object correspondence process is performed by turning the face unit 31 toward the head of a person in the vicinity (object correspondence 1) and outputting a sound to the person in the vicinity (object correspondence 2), or by combining these, after the movement of the mobile robot 100 is stopped. Note that, similar to the above-mentioned person correspondence 1, object correspondence 3, which stops in front of an obstacle, may be performed. The dotted arrow in the figure indicates the moving route of the mobile robot 100.

[0102] 10(a) shows a state in which the mobile robot 100 is stopped in front of an obstacle (object). At this time, the obstacle detection unit 13 detects the positions of people around the mobile robot 100, in particular the positions of the heads of the people.

[0103] Then, as shown in FIG. 10(b), the obstacle response unit 14 (head directionThe control unit 14a) may, as an object response process, direct the face unit 31 toward the head of a person in the vicinity (object response 1). This allows the mobile robot 100 to actively appeal to the person in the vicinity that its movement path is blocked by an obstacle. At this time, by outputting a predetermined sound to the person toward whom the face unit 31 is directed (object response 2), the mobile robot 100 can directly appeal to the person in the vicinity to remove the obstacle from its movement path. The type of sound output at this time may be different from that during the person response process, and may be, for example, the following sound:

[0104] That is, the obstacle response unit 14 (alert control unit 14b) may output a voice such as "please move the object" to people in the vicinity, requesting that the obstacle be removed from the movement path, by the object response process (object response 2). This allows the mobile robot 100 to more accurately appeal to people in the vicinity to remove the obstacle from the movement path in order to secure the movement path. In addition, a so-called directional speaker may be adopted as the speaker 5 that outputs the sound. This makes it possible to ask for help only from specific people in the vicinity, even in a scene where sound cannot be emitted unnecessarily. In addition, the object response 2 may be executed in a stationary state (object response 3) shown in FIG. 10(a). In that case, the mobile robot 100 may output a sound such as "someone please move the object" toward the surroundings without limiting the target to which the sound is output. Note that when outputting a sound in the object response process, the type of sound, the volume, the number of times the sound is repeated, and the duration of the sound output may be appropriately changed, similar to the above-mentioned human response process.

[0105] Although not shown, the obstacle correspondence unit 14 may use the arm 40 to point out an obstacle to be removed as an object correspondence process (object correspondence 4). This allows the mobile robot 100 to more accurately communicate to people around it an obstacle to be removed from the moving path. Various actions may be adopted as the action of pointing out an obstacle. For example, the mobile robot 100 may perform an action of pointing the tip of the arm 40 toward the obstacle as a person would point at an object, or may further perform an action of moving the tip of the arm 40 back and forth relative to the obstacle to more emphasize the obstacle to be removed. Object correspondence 4 may also be executed in combination with any one or more of the above-mentioned object correspondences 1 to 3.

[0106] The above is the details of the object response process of this embodiment. When the obstacle is an object, the obstacle response unit 14 is configured to execute one or more predetermined responses selected from the above-mentioned object responses 1 to 4 with respect to people in the vicinity.

[0107] The above is the details of the movement control performed by the mobile robot 100 of one embodiment. Note that the flowcharts shown in Figures 4, 5, and 7 are examples for explaining the movement control of this embodiment, and are not limited to being executed exactly as shown in the drawings, and may be modified as appropriate as long as the above-mentioned technical effects are achieved.

[0108] For example, step S133 shown in Fig. 5 may be deleted as described above. In this case, the mobile robot 100 may be configured to attempt to generate an avoidance route when an obstacle is detected, and to execute an obstacle handling process when an appropriate avoidance route is not generated.

[0109] Furthermore, when an obstacle is detected (S131, YES judgement) and the obstacle is not removed from the travel route even after a predetermined time has elapsed since the above-mentioned predetermined response was performed as the obstacle response process, the mobile robot 100 may attempt to generate a travel route (avoidance route) that avoids the obstacle from the current location to reach the destination (S134). In this way, when an obstacle is detected, the mobile robot 100 may be configured to first perform the obstacle response process, and then generate an avoidance route if the obstacle is not removed from the travel route even after a predetermined time has elapsed. Note that the predetermined time here may be set appropriately and is not particularly limited.

[0110] The above is the details of the mobile robot 100 of this embodiment. As described above, when an obstacle is detected on the moving path, the mobile robot 100 regenerates a moving path that can reach the destination by avoiding the obstacle, and when such a path cannot be regenerated, executes a predetermined action to remove the obstacle from the moving path. Alternatively, when an obstacle is detected on the moving path, the mobile robot 100 executes a predetermined action to remove the obstacle from the moving path, and when the obstacle is not removed even after executing the predetermined action, executes a moving path that can reach the destination by avoiding the obstacle. As a result, even when the moving path is blocked by an obstacle, the mobile robot 100 can actively secure the moving path and move to the destination, thereby suppressing a decrease in work efficiency.

[0111] Although the embodiments of the present invention have been described above, the above-mentioned embodiments merely show some of the application examples of the present invention, and it is not intended that the technical scope of the present invention be limited to the specific configurations of the above-mentioned embodiments.

[0112] For example, the notification means 5 does not necessarily need to be a speaker, and may be a lamp, a laser, a display, or the like that appeals to the human visual sense using light. Furthermore, even when a predetermined notification is made using the notification means 5 configured in this way in the obstacle response process, the obstacle response unit 14 may change the strength of the prompting at predetermined time intervals. For example, even when a predetermined notification is made using a display as the notification means 5, the obstacle response unit 14 may change the strength of the prompting related to the content displayed on the display at predetermined time intervals, similar to the predetermined notification using the speaker described above.

[0113] 2 may be modified as appropriate as long as it includes at least the head 30 and is configured to be movable along a movement path. For example, the mobile robot 100 does not need to include the robot main body 10. In this case, the head 30 may be configured to be directly mounted on the mobile carriage 20. [Industrial Applicability]

[0114] The present invention can be used at least in industries that manufacture robot control devices and the like. [Explanation of symbols]

[0115] 1 Controller 3 Head drive means (drive means) 5 Speakers 11. Travel Route Generate Department 12 Movement control section 13 Obstacle detection section 14 Obstacle Response Department twenty one skirt twenty two Drive wheels 30 head 40 Arm 100 Mobile Robot 300 Obstacles

Claims

1. A robot control device for controlling a mobile robot, A travel route generation unit that generates a travel route from a current location to a destination; a movement control unit that moves the mobile robot along the generated movement path; an obstacle detection unit that detects an obstacle on the movement path within a predetermined distance; an obstacle response unit that executes a predetermined response to remove the obstacle from the movement path; The mobile robot has a head having a face on the front side; A driving means for driving the head, The obstacle detection unit detects whether the obstacle is a person, the obstacle response unit executes one or more of the predetermined responses selected depending on whether the obstacle is a person or not; If the detected obstacle is a person, The obstacle detection unit detects a position of the person's head, A robot control device, wherein the obstacle response unit controls the driving means of the mobile robot to direct the face of the mobile robot toward the head of the person as the predetermined response.

2. a specifying unit that specifies the person closest to the mobile robot when the detected obstacle is a person and there are a plurality of people; The robot control device according to claim 1 , wherein when the predetermined response is to direct the face of the mobile robot toward the head of the person, the obstacle response unit directs the face of the mobile robot toward the head of the person identified by the identification unit.

3. an identification unit that, when the detected obstacle is a person and there are a plurality of people, identifies a person that is predicted to be first contacted or collided with when the mobile robot moves, The robot control device according to claim 1 , wherein when the predetermined response is to direct the face of the mobile robot toward the head of the person, the obstacle response unit directs the face of the mobile robot toward the head of the person identified by the identification unit.

4. If the detected obstacle is not a person, the obstacle detection unit detects a position of a head of a person in the vicinity of the mobile robot; The robot control device according to claim 1 , wherein the obstacle response unit controls the driving means to direct the face unit toward a head of the person nearby, as the predetermined response.

5. The robot control device according to claim 1 , further comprising: a notification unit for issuing a predetermined notification as the predetermined response.

6. The mobile robot includes a speaker as the notification means, The robot control device according to claim 5 , wherein the obstacle response unit outputs, as the predetermined response, a predetermined sound selected depending on whether the obstacle is a person or not, using the speaker.

7. The predetermined sound includes a plurality of types of sounds having different strengths of influence, The robot control device according to claim 6 , wherein the obstacle response unit changes the type of the predetermined sound every predetermined time so as to increase the degree of the influence.

8. The robot control device according to claim 6 or 7, wherein the obstacle response unit increases a volume of the predetermined sound at predetermined time intervals.

9. The robot control device according to claim 6 , wherein at least one of the type, volume, number of times of output, and duration of output of the predetermined sound output by the obstacle response unit can be set in advance.

10. The robot control device according to claim 6 , wherein the speaker is disposed so that the predetermined sound is output from the head of the mobile robot.

11. The robot control device according to claim 5 , wherein the obstacle response unit changes a strength of the action by the notification means at predetermined time intervals.

12. the travel route generation unit generates, when the obstacle is detected, a travel route from a current location to the destination while avoiding the obstacle; The robot control device according to claim 1 , wherein the obstacle response unit executes the predetermined response when a travel route from a current location to the destination while avoiding the obstacle cannot be generated.

13. 12. A robot control device according to claim 1, wherein the travel path generation unit generates a travel path from a current location to the destination while avoiding the obstacle when the obstacle is detected and the obstacle is not removed from the travel path even after a predetermined time has elapsed since the obstacle response unit performed the predetermined response.

14. The robot control device according to claim 1 , wherein the movement control unit decelerates or stops the mobile robot when the obstacle is detected during movement.

15. The robot control device according to claim 14 , wherein the obstacle response unit maintains the stopped state of the mobile robot as the predetermined response when the mobile robot is stopped upon detection of the obstacle.

16. The robot control device according to claim 1 , wherein the mobile robot further comprises one or more arms having a manipulator mechanism.

17. The robot control device according to claim 16 , wherein, when the detected obstacle is not a person, the obstacle response unit points to the obstacle using the arm as the predetermined response.

18. A robot control method for controlling a mobile robot, comprising: A travel route generation step of generating a travel route from a current location to a destination; a movement control step of moving the mobile robot along the generated movement path; an obstacle detection step of detecting an obstacle on the movement path; an obstacle response step of performing a predetermined response to remove the obstacle from the travel path; In the obstacle detection step, it is detected whether the obstacle is a person or not, In the obstacle response step, one or more of the predetermined responses are executed depending on whether the obstacle is a person or not. In the obstacle detection step, when the detected obstacle is a person, In the obstacle detection step, a position of a head of the person is detected; In the obstacle response step, the predetermined response is to turn a face portion provided in front of a head of the mobile robot toward the head of the person. A method for controlling a robot.

19. A robot control program for controlling a mobile robot, A travel route generation step of generating a travel route from a current location to a destination; a movement control step of moving the mobile robot along the generated movement path; an obstacle detection step of detecting an obstacle on the movement path; an obstacle response step of performing a predetermined response to remove the obstacle from the travel path; In the obstacle detection step, it is detected whether the obstacle is a person or not, In the obstacle response step, one or more of the predetermined responses are executed depending on whether the obstacle is a person or not. In the obstacle detection step, when the detected obstacle is a person, In the obstacle detection step, a position of a head of the person is detected; In the obstacle response step, the predetermined response is to turn a face portion provided in front of a head of the mobile robot toward the head of the person. Robot control program.

Citation Information

Patent Citations

  • Flow rate adjusting device for liquid

    JP1989012179A

  • Autonomous mobile robot

    JP2001129787A

  • Moving device, moving method and program

    JP2011204145A

  • Mobile human interface robot

    JP2013537487A

  • Unmanned moving body and method of creating route for unmanned moving body

    JP2016081403A