Mobile body and its control device, control method and control program, mobile manipulator and system

The mobile object adjusts speed based on area-specific information to balance safety and workability, addressing the inefficiencies of conventional safety measures by allowing high speeds in safe zones and lower speeds in human-shared areas.

JP7586457B2Active Publication Date: 2024-11-19TOKYO ROBOTICS INC
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
JP2020088077
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2020-05-20
Publication Date
2024-11-19
Estimated Expiration
2040-05-20

AI Technical Summary

Technical Problem

Conventional techniques for ensuring safety during the movement of autonomous mobile robots often reduce workability by incorrectly identifying dangerous locations, leading to unnecessary speed reductions and decreased efficiency.

Method used

A mobile object that includes a self-location specifying unit, area movement speed information, and a moving speed control section to adjust speed based on specific areas, allowing high speeds in safe zones and lower speeds in human-shared areas, with features like SLAM-generated environmental maps and deceleration/acceleration controls.

Benefits of technology

Achieves both safety and workability by dynamically adjusting speed according to the environment, ensuring efficient movement in shared spaces with humans.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007586457000001
    Figure 0007586457000001
  • Figure 0007586457000002
    Figure 0007586457000002
  • Figure 0007586457000003
    Figure 0007586457000003
Patent Text Reader

Abstract

To provide a mobile body and the like which can secure both safety and workability under an environment whose space is shared by the mobile body and a human being and the like.SOLUTION: The present invention is directed to a mobile body autonomously travelling within predetermined space A, B, C, and D. The mobile body has a self location identifying unit for identifying a self location of the mobile body, a travel speed identifying unit for identifying an area travel speed as a travel speed associated with the area corresponding to the self location based on the self location of the mobile body and area travel speed information set for each of one or more areas set in the space in association with the travel speed of the mobile body, and a travel speed control unit for controlling the travel speed of the mobile body based on the area travel speed.SELECTED DRAWING: Figure 5
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a moving body that moves autonomously within a given environment, such as a mobile manipulator. [Background technology]

[0002] In recent years, the development of autonomous mobile robots that can move in environments where humans coexist has been progressing. For autonomous mobile robots, it is essential to ensure safety so that they do not collide with humans or other mobile robots that share the same space.

[0003] For example, Patent Document 1 discloses a movement control technology that allows a moving body to avoid collisions at dangerous locations such as intersections where people or moving obstacles are expected to jump out. In this document, the moving body uses a distance measurement sensor to detect objects in the environment, and in a given case, extracts the edge points of the objects as dangerous locations and performs a given collision avoidance operation such as slowing down the approach speed. [Prior art documents] [Patent documents]

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

[0005] However, conventional techniques aimed at ensuring the safety of autonomous mobile robots while they are moving may result in a decrease in the operability of the autonomous mobile robot.

[0006] For example, in the technology described in Patent Document 1, dangerous areas are detected based only on the results of object detection in the environment by a distance sensor, so there is a risk of erroneous detection of objects when humans or objects of various shapes are placed in the environment. As a result, the autonomous mobile robot may judge an area that is not actually dangerous as dangerous and unnecessarily slow down, etc., resulting in a risk of degrading workability. In addition, even if an area is judged to be dangerous based on its external appearance through object detection, it is assumed that the area is actually prohibited for humans or other moving objects, and there is no need to slow down the moving speed, but when the technology is used, the speed is uniformly reduced, which may degrade workability.

[0007] The present invention has been made to solve the above-mentioned technical problems, and an object of the present invention is to provide a mobile body etc. that can achieve both safety and operability in an environment where space is shared with humans etc. [Means for solving the problem]

[0008] The above-mentioned technical problems can be solved by a moving body or the like having the following configuration.

[0009] In other words, the moving body of the present invention is a moving body that moves autonomously within a specified space, and is equipped with a self-location determination unit that determines the self-location of the moving body, a movement speed determination unit that determines a region movement speed, which is the movement speed associated with the region corresponding to the self-location, based on region movement speed information that is set by correlating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body, and a movement speed control unit that controls the movement speed of the moving body based on the region movement speed.

[0010] According to such a configuration, the moving speed of the moving body can be controlled to be an appropriate moving speed for each area based on the area moving speed information and the self-position, so that, for example, the moving body can be moved at a high speed in an area where workability can be prioritized over ensuring safety, such as an area where people, etc. are prohibited from entering, and the moving body can be moved at a low speed in an area where ensuring safety should be prioritized, such as an area shared with people, etc. As a result, it is possible to achieve both safety and workability of the moving body in an environment where space is shared with people, etc.

[0011] The area movement speed information may be a movement speed map in which the movement speed of the moving object is associated with each of one or more areas set in an environmental map corresponding to the space.

[0012] According to this configuration, a movement speed map can be set arbitrarily based on an environmental map corresponding to the space in which autonomous movement takes place, so that a movement speed can be set appropriately according to the environment.

[0013] The vehicle may further include a route planning unit that plans a route from the self-location to a predetermined movement end point or a waypoint on the way to the movement end point based on the self-location.

[0014] According to this configuration, a route to an end point or a waypoint can be appropriately planned based on the own position.

[0015] The self-location determination unit may further include an environment recognition unit that recognizes the environment around the moving body and generates environmental information, and a self-location estimation unit that estimates the self-location of the moving body based on the environmental information to determine the self-location.

[0016] According to this configuration, it is possible to move while estimating the self-position based on the environmental information.

[0017] The moving body may further include a setting input unit inside or outside the moving body that enables an area and a corresponding moving speed to be arbitrarily set on the environmental map.

[0018] According to such a configuration, a person in charge of managing the moving object can arbitrarily set a moving speed corresponding to the area.

[0019] The setting input unit may further include a property information setting input unit that enables the setting of the properties of the area corresponding to the area, and an automatic movement speed setting unit that automatically sets a predetermined movement speed for the area based on the setting regarding the properties of the area.

[0020] According to such a configuration, the movement speed can be set for each area simply by setting the property of the area, so that the movement speed can be easily set.

[0021] The nature of the area may include that the area is a human-coexistence area.

[0022] According to this configuration, by setting that a region is a human-coexistence region, the moving speed can be indirectly set for each region, so that the moving speed can be easily set. Note that a region being a human-coexistence region includes settings with substantially the same meaning, such as a region being a human-absent region. Also, it does not necessarily have to be set as a binary value.

[0023] The environmental map may be generated by Simultaneous Localization And Mapping (SLAM).

[0024] With this configuration, an appropriate environmental map can be generated using SLAM even in unknown spaces.

[0025] The environmental map may be generated by a CAD system.

[0026] According to this configuration, an environmental map can also be generated using CAD.

[0027] The environmental map may further include cost information that is an index of movement restrictions for the mobile object.

[0028] According to such a configuration, it is possible to further incorporate a travel restriction index into the environmental map, thereby improving the safety of the moving body.

[0029] The cost information may further include cost information in which the cost decreases as the distance from surrounding obstacles increases.

[0030] According to such a configuration, it is possible to move while taking into consideration the distance from an obstacle based on the cost information, thereby realizing safe movement.

[0031] The system may further include a region transition detection unit that detects when the moving body enters from a first region of the regions into an adjacent second region, and a deceleration control unit that, when entry from the first region to the second region is detected, controls the moving body to start decelerating within the first region if the moving speed associated with the first region is greater than the moving speed associated with the second region.

[0032] According to this configuration, when the moving body enters the low speed area from the high speed area, the moving speed is already sufficiently reduced, so that safety in the low speed area can be further improved.

[0033] The deceleration control unit may further control the movement speed of the moving body to a movement speed associated with the second area when the moving body enters the second area from the first area or immediately before or after the entry.

[0034] According to this configuration, when a moving body enters a low speed area from a high speed area, the moving body is already at a moving speed associated with the low speed area, so that safety in the low speed area can be further improved.

[0035] The device may further include an acceleration control unit that controls the moving body to start accelerating after entering the second area when entry from the first area to the second area is detected and the moving speed associated with the first area is lower than the moving speed associated with the second area.

[0036] According to this configuration, when the moving body enters the high speed region from the low speed region, acceleration begins after the moving body enters the high speed region, so safety in the low speed region is maintained in this case as well.

[0037] The vehicle may further include an environment recognition unit that recognizes the environment around the vehicle and generates environmental information, an unknown obstacle detection unit that detects unknown obstacles that do not exist in the environmental map based on the environmental information, and a movement speed setting unit that sets a movement speed around the unknown obstacle for a specified area around the unknown obstacle.

[0038] According to such a configuration, the vehicle can move at a speed specific to the vicinity of an unknown obstacle, for example, at a slow speed, thereby making it possible to further improve the safety of the movement.

[0039] The movement speed setting unit may further include a movement speed comparison unit that compares a basic movement speed, which is a movement speed associated with the area corresponding to the position of the unknown obstacle, with the movement speed around the unknown obstacle, and a selective movement speed setting unit that sets the movement speed around the unknown obstacle for a predetermined area around the unknown obstacle when the basic movement speed is greater than the movement speed around the unknown obstacle, and sets the basic movement speed for the predetermined area around the unknown obstacle when the basic movement speed is smaller than the movement speed around the unknown obstacle.

[0040] According to this configuration, in the vicinity of an unknown obstacle, the smaller of the movement speed in the vicinity of the unknown obstacle and the movement speed associated with the area in which the unknown obstacle is located is selected and set, thereby realizing safe movement of the moving body.

[0041] The moving body may be configured to be capable of transporting luggage, and may further include a transport speed control unit that controls the moving speed of the moving body to be reduced during the transport.

[0042] According to such a configuration, the momentum of the moving body can be reduced by reducing the moving speed, thereby improving safety in the event of an unexpected collision or the like.

[0043] The moving body may be configured to be capable of transporting luggage, and may further include a transportation acceleration control unit that controls the acceleration and / or deceleration of the moving body to be reduced during the transportation.

[0044] According to this configuration, the effect of inertia increased by transporting luggage can be reduced by reducing the acceleration or deceleration, and therefore the possibility of dropping or collapsing the luggage can be reduced. Also, safety in the event of an unexpected collision can be improved. In other words, the safety of travel can be further improved.

[0045] The route planning unit may further include a minimum travel time route planning unit that plans a route so as to minimize the travel time from the self-location to a predetermined travel end point or a waypoint on the way to the travel end point.

[0046] According to this configuration, a route that can be traveled in the shortest time is planned taking into account the travel speed associated with each area, so that workability can be improved while ensuring safety.

[0047] The moving body may further include a robot manipulator.

[0048] According to this configuration, since the robot is equipped with a robot manipulator, it can perform predetermined tasks and grasp and transport loads in addition to moving.

[0049] The present invention can be conceived as a control device for a moving body. That is, the control device according to the present invention is a control device for a moving body that moves autonomously in a predetermined space, and includes a self-location determination unit that determines the self-location of the moving body, a movement speed determination unit that determines a region movement speed that is the movement speed associated with the region corresponding to the self-location based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body, and a movement speed control unit that controls the movement speed of the moving body based on the region movement speed.

[0050] The present invention can be conceived as a method for controlling a moving body. That is, the control method according to the present invention is a method for controlling a moving body that autonomously moves in a predetermined space, and includes a self-location identification step of identifying the self-location of the moving body, a movement speed identification step of identifying a region movement speed, which is the movement speed associated with the region corresponding to the self-location, based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body, and a movement speed control step of controlling the movement speed of the moving body based on the region movement speed.

[0051] The present invention can be conceived as a control program for a moving body. That is, the control program according to the present invention is a control program for a moving body that autonomously moves in a predetermined space, and includes a self-location identification step of identifying the self-location of the moving body, a movement speed identification step of identifying a region movement speed, which is the movement speed associated with the region corresponding to the self-location, based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body, and a movement speed control step of controlling the movement speed of the moving body based on the region movement speed.

[0052] The present invention can be conceived as a mobile manipulator. That is, the mobile manipulator according to the present invention is a mobile manipulator that autonomously moves within a predetermined space, and includes a self-location identification unit that identifies the self-location of the moving body, a movement speed identification unit that identifies a region movement speed that is the movement speed associated with the region corresponding to the self-location based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body, and a movement speed control unit that controls the movement speed of the moving body based on the region movement speed.

[0053] The present invention can be conceived as a system. That is, the system according to the present invention is a system including a moving body that moves autonomously in a predetermined space, and includes a self-location identification unit that identifies the self-location of the moving body, a movement speed identification unit that identifies a region movement speed that is the movement speed associated with the region corresponding to the self-location based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body, and a movement speed control unit that controls the movement speed of the moving body based on the region movement speed. Effect of the Invention

[0054] According to the present invention, it is possible to provide a moving body or the like that is capable of achieving both safety and workability in an environment where space is shared with humans or the like. [Brief description of the drawings]

[0055] [Figure 1] FIG. 1 is a diagram showing the overall configuration of the control system. [Diagram 2] FIG. 2 is a perspective view of the appearance of the mobile manipulator. [Diagram 3] FIG. 3 is a general flowchart for generating a movement speed map. [Figure 4] FIG. 4 is a diagram showing an example of the generated global environment map. [Diagram 5] FIG. 5 is a diagram showing an example of a travel speed map. [Figure 6] FIG. 6 is a general flowchart of the autonomous movement operation of the mobile manipulator. [Figure 7] FIG. 7 is a detailed flowchart of the route movement process. [Figure 8] FIG. 8 is an explanatory diagram of a case where the mobile manipulator transitions between areas. [Figure 9] FIG. 9 is an explanatory diagram showing the state of a mobile manipulator approaching an unknown obstacle. [Figure 10] FIG. 10 is an explanatory diagram regarding setting of a moving speed in the vicinity of an unknown obstacle. [Figure 11] FIG. 11 is an explanatory diagram showing the acceleration state of a mobile manipulator gripping a load. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0056] BEST MODE FOR CARRYING OUT THE PRESENT DISCLOSURE Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings of FIGS.

[0057] 1. First Embodiment As a first embodiment, an example in which the present invention is applied to a mobile manipulator that autonomously moves within a factory and performs work using an arm or a hand will be described. Note that in this embodiment, a mobile manipulator is exemplified as a moving body, but the present invention is not limited thereto. Therefore, the present invention can also be applied to, for example, an autonomous vehicle, an unmanned guided vehicle, an electric wheelchair, other moving robots, and the like.

[0058] (1.1 System Configuration) The configuration of a control system 500 according to this embodiment will be described with reference to FIGS.

[0059] Fig. 1 is an overall configuration diagram of a control system 500. As is clear from the diagram, the control system 500 is configured by connecting a plurality of mobile manipulators 100, a server 200, and a client device 300 to each other via a LAN in a factory.

[0060] The server 200 is made up of an information processing device, and stores various types of information and provides various types of information in response to requests from the mobile manipulator 100 and the client device 300 .

[0061] The server 200 is configured by including a control unit consisting of a CPU or the like that executes various programs, a memory unit consisting of a ROM, RAM, flash memory or the like that stores the programs to be executed and various data, a communication unit that communicates with external devices, an input unit for processing input from a keyboard, mouse, etc., a display unit that displays various images, and the like, all of which are connected to each other via a bus.

[0062] The client device 300 is an information processing device that cooperates with the server 200 to provide management information on the control system 500 to a system administrator or the like, and also enables the user to input various settings, as described below.

[0063] The client device 300 includes a control unit consisting of a CPU or the like that executes various programs, a memory unit consisting of a ROM, RAM, flash memory or the like that stores the programs to be executed and various data, a communication unit that communicates with external devices, an input unit for processing input from a keyboard, mouse, etc., a display unit that displays various images, and the like, all of which are connected to each other via a bus.

[0064] 2 is a perspective view of the exterior of the mobile manipulator 100. As is clear from the figure, the mobile manipulator 100 of this embodiment has a roughly humanoid shape and is composed of a robot main body 10, a movable carriage 20 that supports the robot main body 10, a head 30 provided at the upper end of the robot main body 10, and arms 40 extending from the front of the robot main body 10.

[0065] The moving dolly 20 supporting the robot main body 10 is an omnidirectional moving dolly that has the function of moving on the surface (floor surface) on which the mobile manipulator 100 is placed. The omnidirectional moving dolly is a dolly that is equipped with, for example, a plurality of omni wheels as drive wheels and is configured to be able to move in all directions. The omnidirectional moving dolly may be called an omnidirectional moving dolly, an omnidirectional moving dolly, or an omnidirectional dolly. The omnidirectional moving dolly can move in all directions of 360 degrees and can move freely even in narrow passages, etc. As shown in the figure, the moving dolly 20 of this embodiment may be composed of three drive wheels 22 and a moving mechanism drive means 2 for driving the drive wheels 22 via a belt or the like inside a skirt 21 shown in the exterior. The moving mechanism drive means 2 of this embodiment is composed of one or more motors, and hereinafter the moving mechanism drive means 2 is also referred to as a motor 2.

[0066] In the mobile manipulator 100 having a substantially human shape, 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 its front side can be recognized as a face when viewed by a person. The head 30 is configured so that the direction in which the front side faces can be controlled. Specifically, the mobile manipulator 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 side can be controlled by moving the head via the head driving means 3. In the following, the front side of the head 30 is referred to as the face 31.

[0067] The mobile manipulator 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 manipulator 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 to rotate the robot main 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 main body 10 left and right relative to the vertical direction.

[0068] The mobile manipulator 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 manipulator 100 to move the face 31 in the vertical direction as well.

[0069] An environment recognition means 32 is provided within a protrusion on the upper edge of the front surface of the movable dolly 20. In this embodiment, the environment recognition means 32 is a LiDAR (Light Detection And Ranging) unit that uses laser light to measure the distance and direction to an object. However, the environment recognition means 32 is not limited to a LiDAR unit, and various other sensors and the like can be adopted. For example, an imaging element may be provided to perform environment recognition by image processing, or a radar, a microphone array, and the like may be used.

[0070] The mobile manipulator 100 has an arm 40 on the front side of the robot body 10. The arm 40 has a manipulator mechanism, and a gripping mechanism 41 for gripping an object 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 drawings, and may be changed appropriately depending on the purpose. For example, the mobile manipulator 100 may be configured as a dual-arm robot having arms 40 on both sides of the robot body 10.

[0071] The above is an example of the configuration of the mobile manipulator 100 of this embodiment. Although omitted in Fig. 2, the mobile manipulator 100 may include other components required to control the operation of the mobile manipulator 100, such as other actuators for driving the arms 40, a battery serving as a power source, and the like.

[0072] (1.2 System Operation) Next, the operation of the control system 500 will be described with reference to FIGS.

[0073] (1.2.1 Preparation Phase) 3 to 5, a process of generating a movement speed map used for controlling the mobile manipulator 100 as preparation for operation will be described. In this embodiment, the global environment map is generated using so-called SLAM (Simultaneous Localization And Mapping).

[0074] 3 is a general flowchart for generating a travel speed map. As is clear from the figure, first, the mobile manipulator 100 equipped with the environment recognition means 32 is moved appropriately within a work area in a factory to acquire environmental information (S11). When the acquisition process of this environmental information is completed, the acquired environmental information is sent together to the server 200 (S12).

[0075] The server 200, which has been in a standby state (S14 NO) until receiving this environmental information, performs a process of generating and storing a global environmental map corresponding to the work area in the factory, including obstacles such as walls, based on the environmental information, and storing the global environmental map (S15) once the server 200 receives the environmental information (S14 YES). Note that the global environmental map can be generated using various methods known to those skilled in the art.

[0076] 4 is a diagram showing an example of a generated global environment map. In the example of the figure, information about obstacles such as walls (corresponding to the straight lines in the figure) is acquired based on environmental information obtained by moving the mobile manipulator 100 from a movement start point (S) in the lower left to a movement end point (G) in the upper right.

[0077] In this embodiment, the global environment map is generated by SLAM, but the present invention is not limited to this configuration. Therefore, the global environment map may be generated by other methods, for example, a two-dimensional or three-dimensional model environment map may be generated by CAD.

[0078] After the generation and storage process of the global environment map is performed, the server 200 then performs a process of generating and storing a global cost map based on the global environment map (S16). The global cost map is generated based on cost information that is an index of the movement restriction of the mobile manipulator 100, and in this embodiment, for example, is map information configured based on costs that become larger the closer to an obstacle such as a wall in the global environment map. As will be described later, when the mobile manipulator 100 plans a route, the route is planned so that the mobile manipulator 100 will preferentially pass through areas with smaller costs, taking safety into consideration.

[0079] When the generation and storage process of the global cost map is completed, the server 200 transmits a setting preparation completion signal indicating that preparation for the moving speed setting process is completed to the client device 300 (S17). Upon receiving this setting preparation completion signal, the client device 300, which had been in a standby state (S19 NO) until then, starts the moving speed setting process (S20).

[0080] When the moving speed setting process (S20) starts, the global environment map and the cost map provided by the server 200 are displayed on the screen of the display unit of the client device 300. In this state, a user such as an administrator of the mobile manipulator 100 can set one or more areas on the global environment map via the input unit of the client device 300. Also, a moving speed can be set for each of the set areas. Area information set on the global environment map set in this way and the corresponding moving speed information are transmitted to the server 100.

[0081] Thereafter, the server 200 performs a process of storing the received area information and the corresponding travel speed information as a travel speed map in the storage unit, and then the series of processes ends.

[0082] 5 is a diagram showing an example of a travel speed map. In the figure, four rectangular regions indicated by A to D are set on the global environment map. A travel speed at which the mobile manipulator 100 should travel is set for each region, and for example, a designated speed of 1.0 [m / s] is set for region A, 0.3 [m / s] for region B, 0.5 [m / s] for region C, and 0.1 [m / s] for region D is set.

[0083] Each moving speed is arbitrarily set by a user, such as an administrator of the mobile manipulator 100, based on various criteria, such as whether the area is shared with humans, whether it is shared with moving obstacles such as other mobile manipulators 100, the placement of obstacles, etc.

[0084] In this embodiment, the configuration has been described in which the area and the movement speed corresponding to the area are set, but the present invention is not limited to this configuration. Therefore, for example, a configuration may be used in which the movement speed corresponding to the area is automatically or indirectly set by setting the property of the area. The property of the area may be, for example, whether it is a human coexistence area or a human absent area. With this configuration, the movement speed can be easily set for each area to be set.

[0085] (1.2.2 Mobile manipulator operation) Next, the operation of the mobile manipulator 100 in the operational phase will be described with reference to FIGS.

[0086] 6 is a general flowchart of the autonomous movement operation of the mobile manipulator 100. As is clear from the figure, when the process starts, the mobile manipulator 100 performs an end point information acquisition process (S31). Note that, in this embodiment, the end point information is coordinate information of a position corresponding to the end point on the global environment map, the global cost map, or the movement speed map.

[0087] In this embodiment, this information is acquired by acquiring the end point information stored in advance in the server 200 via the client device 300 via the network. However, the process of acquiring the end point information is not limited to the configuration of this embodiment, and for example, the end point information stored in advance in the mobile manipulator 100 may be read out.

[0088] In this embodiment, a configuration for acquiring end point information is described; however, the present invention is not limited to such a configuration, and for example, information on intermediate points set on the way to the end point may be further acquired.

[0089] After the end point information is acquired, various setting information stored in the server 200 is acquired via the network (S33). More specifically, a global environment map, a global cost map, a travel speed map, and the like are acquired.

[0090] When this acquisition process is completed, the mobile manipulator 100 starts the path movement process (S35).

[0091] 7 is a detailed flowchart of the path movement process (S35). As is clear from the figure, when the process starts, the mobile manipulator 100 performs a process of acquiring environmental information using the environment recognition means 32 (S351).

[0092] After acquiring the environmental information, the mobile manipulator 100 then performs recognition processing of the local environment around itself based on the environmental information, and performs self-location estimation processing on the global environment map, the global cost map, or the moving speed map (S352). Note that various methods known to those skilled in the art can be applied to this self-location estimation processing.

[0093] After the self-location estimation process is performed, a process is performed to determine the moving speed based on the estimated self-location and the moving speed map (S353). More specifically, the area to which the estimated self-location coordinates belong is determined based on the estimated self-location coordinates, and the moving speed associated with the area is read out, thereby determining the moving speed at the estimated self-location.

[0094] After the movement speed determination process, a process (path planning) for planning a movement route is performed (S354). In this embodiment, a local cost map of the periphery of the mobile manipulator 100 is generated from the environmental information, and a route from the estimated self-position to the end point is generated. More specifically, a route is planned in which the cost is equal to or less than a predetermined threshold and the arrival time to the end point is minimized, taking into account the movement speed associated with the passing area. However, the path planning method is not limited to such a method, and any method known to a person skilled in the art may be used.

[0095] According to this configuration, a route that can be traveled in the shortest time is planned taking into consideration the travel speed associated with each area, so that it is possible to improve workability while ensuring safety. Note that the order of the processes shown in this embodiment is an example, and for example, the order of the travel speed determination process (S353) and the route planning process (S354) can be appropriately changed.

[0096] When the path planning process is completed, a movement control process (S356) is performed, i.e., a process of controlling the movement mechanism driving means 2 so that the movement mechanism moves along the path planned in the path planning process (S354) at the movement speed identified in the movement speed identification process (S353).

[0097] After that, when the movement control process is completed, a process of determining whether the mobile manipulator 100 has arrived at the end point is performed (S358). That is, a self-position estimation process is performed, and a process of determining whether the coordinates corresponding to the estimated self-position match the end point coordinates or are sufficiently close to the end point coordinates is performed. If the coordinates corresponding to the estimated self-position are not yet sufficiently close to the end point coordinates (S358NO), a series of processes (S351 to S358) are repeated again. On the other hand, if the coordinates corresponding to the estimated self-position match the end point coordinates or are sufficiently close to the end point coordinates (S358YES), the path movement process ends. In addition, the general flowchart of the autonomous movement operation of the mobile manipulator 100 shown in FIG. 6 also ends accordingly.

[0098] According to such a configuration, the moving speed of the mobile manipulator 100 can be controlled to be appropriate for each area based on the moving speed map and the estimated self-position, so that the mobile manipulator 100 can move at a high speed in an area where workability can be prioritized over ensuring safety, such as an area where humans are prohibited from entering, and can move at a low speed in an area where safety should be prioritized, such as an area shared with humans. As a result, it is possible to achieve both safety and workability of the mobile manipulator 100 in an environment where the space is shared with humans. Furthermore, since the moving speed map can be set arbitrarily based on an environmental map corresponding to the space in which autonomous movement is performed, the moving speed can be set appropriately according to the environment.

[0099] (2. Modifications) Various modifications can be made to the above-described embodiment, and modifications will be described below.

[0100] (2.1 Controlling movement speed during area transition) In the above embodiment, attention is focused on the moving speed of the area to which the vehicle currently belongs based on the estimated self-location, but the present invention is not limited to this configuration.

[0101] FIG. 8(A) is an explanatory diagram of a case where the mobile manipulator 100 enters from a region associated with a high movement speed (high speed region) into a region associated with a low movement speed (low speed region).

[0102] As is clear from the figure, the mobile manipulator 100 (R in the figure), moving from left to right in the figure, starts decelerating from position a1 when it detects that it is entering a low-speed area from a high-speed area on the planned route. It then continues to decelerate, and reaches a moving speed associated with the low-speed area at position a2, which is the boundary from the high-speed area to the low-speed area. After entering the low-speed area, it moves at the moving speed associated with the low-speed area.

[0103] FIG. 8(B) is an explanatory diagram of the case where the mobile manipulator 100 enters from a low speed region into a high speed region.

[0104] As is clear from the figure, the mobile manipulator 100 (R in the figure) moving from left to right in the figure starts accelerating from position b1 where it crosses the boundary from the low speed region to the high speed region. After that, it continues accelerating and reaches a moving speed corresponding to the high speed region at position b2, and thereafter moves at the moving speed corresponding to the high speed region.

[0105] With this configuration, when the mobile manipulator 100 enters a low-speed region from a high-speed region, the moving speed is already sufficiently reduced or is at a moving speed associated with the low-speed region, thereby further improving safety in the low-speed region.

[0106] Furthermore, when the mobile manipulator 100 enters a high speed region from a low speed region, it starts accelerating after entering the high speed region, so safety in the low speed region is maintained in this case as well.

[0107] (2.2 Speed ​​control in the vicinity of unknown obstacles) In the above embodiment, a case has been described in which there is no change to the initial global environment map, but the present invention is not limited to such a configuration.

[0108] 9 is a diagram illustrating the mobile manipulator 100 (R in the figure) approaching an unknown obstacle (O in the figure) that did not exist in the initial global environment map from the left in the figure. In the figure, when the mobile manipulator 100 detects an unknown obstacle, a process is performed to set a new movement speed for the area (D in the figure) near the unknown obstacle. The movement speed set at this time is a movement speed relatively smaller than other areas, and may be, for example, 0.3 [m / s].

[0109] According to this configuration, the vehicle can move at a low speed near unknown obstacles, thereby improving the safety of the movement.

[0110] In addition, in the example shown in FIG. 9, a value set as the moving speed in the vicinity of an unknown obstacle is used regardless of the moving speed associated with the area, but the present invention is not limited to this configuration.

[0111] FIG. 10(A) is a diagram (part 1) for explaining the setting of the movement speed near an unknown obstacle. In this diagram, an unknown obstacle (O in the diagram) is placed in an area D1, and an area D2 is set near the unknown obstacle. The movement speed associated with the area D1 is higher than the movement speed near the unknown obstacle associated with the area D2. For example, the movement speed in the area D1 is 1.0 [m / s], and the movement speed in the area D2 is 0.3 [m / s].

[0112] At this time, when the mobile manipulator 100 detects an unknown obstacle, it sets the moving speed in the vicinity of the unknown obstacle to region D2. That is, in this example, it sets the moving speed to 0.3 [m / s].

[0113] FIG. 10(B) is a diagram (part 2) for explaining the setting of the movement speed near the unknown obstacle. As in FIG. 10(A), an unknown obstacle (O in the diagram) is placed in the area D3, and an area D4 is set near the unknown obstacle. However, in the example of the diagram, the movement speed associated with the area D3 is smaller than the movement speed near the unknown obstacle associated with the area D4. For example, the movement speed in the area D3 is 0.1 [m / s], and the movement speed in the area D4 is 0.3 [m / s].

[0114] At this time, when the mobile manipulator 100 detects an unknown obstacle, it sets the movement speed associated with the area D3 to the area D4. That is, in this example, 0.1 [m / s] is set for the area D4.

[0115] According to this configuration, when near an unknown obstacle, the smaller of the movement speed near the unknown obstacle and the movement speed associated with the area in which the obstacle is located is selected and set, thereby realizing safe movement of the mobile manipulator 100.

[0116] (2.3 Controlling the moving speed during luggage transport) In the above-described embodiment, the case where the mobile manipulator is transporting luggage, for example, gripping or carrying luggage, work, etc., is not taken into consideration, but the present invention is not limited to such a configuration.

[0117] For example, when the mobile manipulator 100 moves while holding or carrying a load, the moving speed may be multiplied by a predetermined coefficient. That is, when the mobile manipulator 100 detects that it is holding or carrying a load, the moving speed may be set by multiplying the moving speed by a coefficient of 0.5 (50%). For example, when the mobile manipulator 100 runs in an area with a moving speed of 1.0 [m / s] while holding or carrying a load, the mobile manipulator 100 may be controlled to move at 0.5 [m / s] by multiplying 1.0 [m / s] by 0.5.

[0118] According to such a configuration, the momentum of the mobile manipulator 100 can be reduced by reducing the moving speed, thereby improving safety in the event of an unexpected collision or the like.

[0119] Furthermore, when the mobile manipulator 100 moves while holding or carrying a load, the acceleration and / or deceleration may be multiplied by a predetermined coefficient. For example, when the mobile manipulator 100 detects that it is holding or carrying a load, the acceleration and / or deceleration during movement may be uniformly multiplied by a coefficient of 0.5 (50%) to set the acceleration and / or deceleration.

[0120] 11(A) is a diagram for explaining the acceleration of the mobile manipulator 100 in a state where no load is being gripped or loaded immediately after entering a high-speed region from a low-speed region. In the figure, position e1 indicates the position where acceleration starts, and position e2 indicates the position where the moving speed corresponding to the high-speed region is reached. That is, in the example of the figure, the distance until the acceleration by the predetermined acceleration is completed is d1.

[0121] 11(B) is a diagram for explaining the acceleration of the mobile manipulator 100 in a state where a load is being gripped or loaded immediately after entering the high-speed region from the low-speed region. In the figure, position e1 indicates the position where acceleration starts, and position e3 indicates the position where the moving speed corresponding to the high-speed region is reached. That is, in the example of the figure, the acceleration is reduced by multiplying it by a predetermined coefficient, so the distance until the acceleration is completed is d2, which is greater than d1.

[0122] According to this configuration, by reducing the acceleration or deceleration, the effect of inertia increased by holding or carrying a load can be reduced, so that the possibility of dropping or collapsing the load can be reduced. Also, safety in the event of an unexpected collision can be improved. In other words, the safety of movement can be further improved.

[0123] Although the embodiments of the present invention have been described above, the above embodiments merely show some of the application examples of the present invention, and the technical scope of the present invention is not limited to the specific configurations of the above embodiments. Moreover, the above embodiments can be appropriately combined within a range where no contradiction occurs. [Industrial Applicability]

[0124] The present invention can be used at least in industries that manufacture autonomous moving objects such as mobile manipulators. [Explanation of symbols]

[0125] 10 Robot body 2. Moving mechanism drive means 20 Mobile trolley 21 Skirt 22 Drive wheels 3 Head drive means 30 head 31 Face 32 Environment recognition means 40 Arm 41 Gripping mechanism 100 Mobile Manipulator 200 Servers 300 Client Device

Claims

1. A moving body that moves autonomously within a predetermined space, A self-location determination unit that determines a self-location of the moving object; a movement speed determination unit that determines a region movement speed, which is the movement speed associated with the region corresponding to the self-location, based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body; a movement speed control unit that controls a movement speed of the moving object based on the area movement speed, a region transition detection unit that detects when the moving object enters a first region of the regions into an adjacent second region; a deceleration control unit that controls the moving object to start decelerating within the first area when entry from the first area to the second area is detected and a moving speed associated with the first area is higher than a moving speed associated with the second area; and The moving body further includes an acceleration control unit that, when entry from the first area to the second area is detected and a moving speed associated with the first area is lower than a moving speed associated with the second area, controls the moving body to start accelerating after entry into the second area.

2. The moving body according to claim 1 , wherein the area movement speed information is a movement speed map in which the movement speed of the moving body is associated with each of one or more areas set in an environmental map corresponding to the space.

3. The mobile body according to claim 1 or 2, further comprising a route planning unit that plans a route from the self-location to a predetermined movement end point or a waypoint on the way to the movement end point based on the self-location.

4. The self-location determination unit further an environment recognition unit that recognizes an environment around the moving object and generates environment information; 4. The moving body according to claim 1, further comprising: a self-position estimating unit that estimates a self-position of the moving body based on the environmental information to specify the self-position.

5. The moving body further includes: The mobile body according to claim 2 , further comprising a setting input unit capable of setting an area and a corresponding moving speed on the environmental map inside or outside the mobile body.

6. The setting input unit further includes: a property information setting input section that enables setting of properties of the area corresponding to the area; The moving body according to claim 5 , further comprising an automatic movement speed setting unit that automatically sets a predetermined movement speed for said area based on a setting related to a property of said area.

7. The mobile body according to claim 6 , wherein the characteristics of the region include that the region is a human coexistence region.

8. 6. The mobile body according to claim 2, wherein the environmental map is generated by Simultaneous Localization and Mapping (SLAM).

9. 6. The mobile body according to claim 2, wherein the environmental map is generated by a CAD system.

10. 10. The mobile body according to claim 2, wherein the environmental map further includes cost information that is an index of a movement restriction of the mobile body.

11. The moving body according to claim 10 , wherein the cost information is such that the cost decreases as the distance from a surrounding obstacle increases.

12. The moving body according to claim 1, wherein the deceleration control unit further controls the moving speed of the moving body to a moving speed associated with the second area when the moving body enters the second area from the first area, or immediately before or after the entry.

13. an environment recognition unit that recognizes an environment around the moving object and generates environment information; an unknown obstacle detection unit that detects an unknown obstacle that does not exist in the environmental map based on the environmental information; The moving body according to any one of claims 2, 5, and 8 to 10, further comprising: a movement speed setting unit that sets an unknown obstacle surrounding movement speed for a predetermined area around the unknown obstacle.

14. The moving speed setting unit further a movement speed comparison unit that compares a basic movement speed, which is a movement speed associated with the area corresponding to the position of the unknown obstacle, with the unknown obstacle surrounding movement speed; 14. The moving body according to claim 13, further comprising a selective movement speed setting unit that sets the unknown obstacle surrounding movement speed for a predetermined area around the unknown obstacle when the basic movement speed is greater than the unknown obstacle surrounding movement speed, and sets the basic movement speed for a predetermined area around the unknown obstacle when the basic movement speed is smaller than the unknown obstacle surrounding movement speed.

15. The moving body is configured to be capable of carrying luggage, The moving body according to any one of claims 1 to 14, further comprising a transportation speed control unit that controls the moving speed of the moving body to be reduced while the luggage is being transported.

16. The moving body is configured to be capable of carrying luggage, The moving body according to any one of claims 1 to 15, further comprising a transportation acceleration control unit that controls the acceleration and / or deceleration of the moving body to be reduced while the luggage is being transported.

17. The route planning unit further The moving body according to claim 3 , further comprising a minimum travel time route planning unit that plans a route so as to minimize a travel time from the self-location to a predetermined travel end point or a waypoint on the way to the travel end point.

18. The moving body according to any one of claims 1 to 17, further comprising a robot manipulator.

19. A control device for a moving body that moves autonomously within a predetermined space, A self-location determination unit that determines a self-location of the moving object; a movement speed determination unit that determines a region movement speed, which is the movement speed associated with the region corresponding to the self-location, based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body; a movement speed control unit that controls a movement speed of the moving object based on the area movement speed, a region transition detection unit that detects when the moving object enters a first region of the regions into an adjacent second region; a deceleration control unit that controls the moving object to start decelerating within the first area when entry from the first area to the second area is detected and a moving speed associated with the first area is higher than a moving speed associated with the second area; and The control device further includes an acceleration control unit that, when entry from the first area to the second area is detected and a moving speed associated with the first area is lower than a moving speed associated with the second area, controls the moving body to start accelerating after entry into the second area.

20. A method for controlling a moving object that moves autonomously within a predetermined space, comprising: A self-location determination step of determining a self-location of the moving object; a movement speed specification step of specifying an area movement speed, which is the movement speed associated with the area corresponding to the self-location, based on area movement speed information set by associating the movement speed of the moving body with each of one or more areas set in the space and the self-location of the moving body; A moving speed control step of controlling a moving speed of the moving body based on the area moving speed, a region transition detection step of detecting that the moving object enters from a first region of the regions into an adjacent second region; a deceleration control step of controlling the moving body to start decelerating within the first area when entry from the first area to the second area is detected and a moving speed associated with the first area is higher than a moving speed associated with the second area; The control method further includes an acceleration control step of controlling the moving body to start accelerating after entering the second area when entry from the first area to the second area is detected and the moving speed associated with the first area is smaller than the moving speed associated with the second area.

21. A control program for a moving object that moves autonomously within a predetermined space, a self-location determination step of determining a self-location of the moving object; a movement speed specification step of specifying an area movement speed, which is the movement speed associated with the area corresponding to the self-location, based on area movement speed information set by associating the movement speed of the moving body with each of one or more areas set in the space and the self-location of the moving body; A moving speed control step of controlling a moving speed of the moving body based on the area moving speed, a region transition detection step of detecting that the moving object enters from a first region of the regions into an adjacent second region; a deceleration control step of controlling the moving body to start decelerating within the first area when entry from the first area to the second area is detected and a moving speed associated with the first area is higher than a moving speed associated with the second area; The control program further includes an acceleration control step of controlling the moving body to start accelerating after entering the second area when entry from the first area to the second area is detected and the moving speed associated with the first area is lower than the moving speed associated with the second area.

22. A mobile manipulator that moves autonomously within a predetermined space, A self-location determination unit that determines a self-location of the moving object; a movement speed determination unit that determines an area movement speed, which is the movement speed associated with the area corresponding to the self-location, based on area movement speed information set by associating the movement speed of the moving body with each of one or more areas set in the space and the self-location of the moving body, a region transition detection unit that detects when the moving object enters a first region of the regions into an adjacent second region; a deceleration control unit that controls the moving object to start decelerating within the first area when entry from the first area to the second area is detected and a moving speed associated with the first area is higher than a moving speed associated with the second area; and and an acceleration control unit that controls the moving body to start accelerating after entering the second area when entry from the first area to the second area is detected and a movement speed associated with the first area is lower than a movement speed associated with the second area.

23. A system including a moving object that moves autonomously within a predetermined space, A self-location determination unit that determines a self-location of the moving object; a movement speed determination unit that determines a region movement speed, which is the movement speed associated with the region corresponding to the self-location, based on region movement speed information set by associating the movement speed of the moving body with each of one or more regions set in the space and the self-location of the moving body; a movement speed control unit that controls a movement speed of the moving object based on the area movement speed, a region transition detection unit that detects when the moving object enters a first region of the regions into an adjacent second region; a deceleration control unit that controls the moving object to start decelerating within the first area when entry from the first area to the second area is detected and a moving speed associated with the first area is higher than a moving speed associated with the second area; and The system further includes an acceleration control unit that, when entry from the first area to the second area is detected and a moving speed associated with the first area is lower than a moving speed associated with the second area, controls the moving body to start accelerating after entry into the second area.

Citation Information

Patent Citations

  • JP1975062364A

  • Control of floor cleaning robot

    JP1998262882A

  • Network robot system, and robot control device, method and program

    JP2010231698A

  • Mobile robot

    JP2012111011A

  • Autonomous mobile body

    JP2018185633A