Control device of mobile object, control method of mobile object and storage medium

By identifying the surrounding conditions of the moving body and generating a path, determining whether the path is in a prescribed area, and rotating on the spot when it is detached, the non-efficient path problem caused by habitual orientation in the prior art is solved, and more efficient path generation and movement is achieved.

CN119739147APending Publication Date: 2025-04-01HONDA MOTOR CO LTD
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
CN202411348984.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2023-09-29
Filing Date
2024-09-25
Publication Date
2025-04-01

AI Technical Summary

Technical Problem

When existing robots generate paths toward the destination, they tend to generate non-efficient paths due to habitual orientation.

Method used

By identifying the surrounding conditions of the moving body and generating a path, it is determined whether the path is in a prescribed area, and if it is detached, the moving body is rotated on the spot and generates a path again to ensure that the path is efficient.

Benefits of technology

It effectively suppresses the generation of non-efficient paths caused by habit orientation, ensuring that the moving body moves to the destination along a more efficient path.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119739147A_ABST
    Figure CN119739147A_ABST
Patent Text Reader

Abstract

Provided are a control device for a mobile body, a control method for a mobile body, and a storage medium that can suppress the generation of a path toward a destination that is not an efficient path in accordance with a robot's habitual direction. The control device for the mobile body includes: a recognition unit that recognizes the surrounding conditions of the mobile body based on at least an image obtained by photographing the surrounding conditions of the mobile body; a generation unit that generates a path from the mobile body to the destination based on the recognized surrounding conditions and a set destination; a determination unit that determines whether the generated path is within a specified area specified based on the current position of the mobile body and the destination; and a control unit that controls the mobile body so that the mobile body moves to the destination along the generated path. When it is determined that the path is out of the specified area, the control unit rotates the mobile body in situ, and the generation unit generates a path from the mobile body rotated in situ to the destination again.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a control device for a mobile object, a control method for a mobile object and a storage medium. Background Art

[0002] In the past, robots that guide users to desired locations or carry goods are known (see, for example, Japanese Patent Application Publication No. 2012-111011). The robots refer to a movement speed database that establishes a correspondence between the maximum movement speed and each area in the environment, and move in a manner that uses the set maximum movement speed as the upper limit.

[0003] However, conventional robots may generate an inefficient path without changing the robot's usual direction when generating a path to a destination. Summary of the invention

[0004] The present invention was completed in consideration of such a situation, and one of its purposes is to provide a control device, a control method and a storage medium for a moving body that can suppress the generation of a path that is not an efficient path but a robot's habitual direction when generating a path toward a destination.

[0005] The control device for a mobile object, the control method for a mobile object, and the storage medium according to the present invention employ the following configurations.

[0006] (1): One embodiment of the present invention relates to a control device for a mobile body, wherein the control device for the mobile body comprises: an identification unit, which identifies the surrounding conditions of the mobile body based on at least an image obtained by photographing the surrounding conditions of the mobile body; a generation unit, which generates a path from the mobile body to the destination based on the identified surrounding conditions and a set destination; a determination unit, which determines whether the generated path is within a specified area specified based on the current position of the mobile body and the destination; and a control unit, which controls the mobile body so that the mobile body moves to the destination along the generated path, and when it is determined that the path is out of the specified area, the control unit rotates the mobile body in situ, and the generation unit again generates a path from the mobile body that has been rotated in situ to the destination.

[0007] (2): Based on the scheme of (1) above, the determination unit determines whether the regenerated path is within the specified area. If it is determined that the regenerated path is within the specified area, the control unit controls the moving body so that the moving body moves to the destination along the regenerated path.

[0008] (3): Based on the scheme of (1) above, the determination unit determines whether the regenerated path is within the specified area. When it is determined that the regenerated path is out of the specified area, the control unit controls the moving body so that the moving body moves along the regenerated path to the vicinity of the boundary of the specified area, and rotates the moving body in situ near the boundary of the specified area, and the generation unit generates a path from the moving body after the in-situ rotation to the destination.

[0009] (4) In the above-mentioned embodiment (1), the predetermined area is an area within a predetermined distance from a reference line connecting the current position of the moving body and the destination.

[0010] (5): Based on the above-mentioned solution (1), the moving body operates in any one of a following mode in which the moving body moves in a manner following the user and an induction mode in which the moving body moves in front of the user in accordance with the moving speed of the user.

[0011] (6) In the above-mentioned embodiment (5), when the mobile body operates in the following mode, the destination is the user or a point within a predetermined range from the user.

[0012] (7): Based on the above-mentioned scheme (5), when the moving body operates in the induction mode, the destination is a place set by the user, or a place within a predetermined range in front of the user.

[0013] (8): In the above-mentioned scheme (5), when the moving body operates in the induction mode, the destination is a temporary point temporarily set in order to reach the final point set by the user.

[0014] (9): Another embodiment of the present invention relates to a method for controlling a moving body, wherein the method for controlling a moving body causes a computer to perform the following processing: identifying the surrounding conditions of the moving body based at least on an image obtained by photographing the surrounding conditions of the moving body; generating a path from the moving body to the destination based on the identified surrounding conditions and a set destination; determining whether the generated path is within a specified area specified based on the current position of the moving body and the destination; controlling the moving body so that the moving body moves to the destination along the generated path; and, if it is determined that the path deviates from the specified area, rotating the moving body in situ and regenerating a path from the moving body rotated in situ to the destination.

[0015] (10): Another embodiment of the present invention relates to a storage medium storing a program, wherein the program causes a computer to perform the following processing: identifying the surrounding conditions of a moving body based at least on an image obtained by photographing the surrounding conditions of the moving body; generating a path from the moving body to the destination based on the identified surrounding conditions and a set destination; determining whether the generated path is within a specified area defined based on the current position of the moving body and the destination; controlling the moving body so that the moving body moves to the destination along the generated path; and, if it is determined that the path deviates from the specified area, rotating the moving body in situ and regenerating a path from the moving body rotated in situ to the destination.

[0016] According to the aspects (1) to (10), when generating a path to a destination, it is possible to prevent a non-efficient path from being generated in accordance with the robot's usual direction. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] Figure 1 This is a diagram showing an example of a configuration of a moving object system including a moving object.

[0018] Figure 2 This is a diagram for explaining an example of the use form of a moving object.

[0019] Figure 3 It is a diagram for explaining the induction mode.

[0020] Figure 4 It is a three-dimensional diagram showing a moving object.

[0021] Figure 5 This is a diagram showing an example of a functional structure of a moving object.

[0022] Figure 6 This is a diagram showing an example of a route generated by the route generation unit.

[0023] Figure 7 This is a diagram showing an example of a route regenerated by the route generating unit.

[0024] Figure 8 This is a diagram for explaining processing executed when a route regenerated by a route generation unit deviates from a predetermined area.

[0025] Fig. 9 This is another diagram for explaining processing executed when the route regenerated by the route generation unit deviates from the predetermined area.

[0026] Fig.10 This is a flowchart showing an example of the flow of processing executed by the control device. DETAILED DESCRIPTION

[0027] Hereinafter, embodiments of a control device for a moving object, a control method for a moving object, and a storage medium according to the present invention will be described with reference to the accompanying drawings.

[0028] Figure 1 1 is a diagram showing an example of a structure of a mobile system 1 including a mobile body 100. The mobile system 1 includes, for example, one or more terminal devices 2, a management device 10, an information providing device 20, and one or more mobile bodies 100. These communicate via, for example, a network NW. The network NW is, for example, any network such as a LAN, a WAN, or an Internet line.

[0029] [Terminal device]

[0030] The terminal device 2 is a computer device such as a smartphone or a tablet terminal. The terminal device 2 requests the management device 10 to provide permission to use the mobile object 100 or obtains information indicating that the use is permitted from the management device 10 based on the operation of the user.

[0031] [Management Device]

[0032] The management device 10 grants the user of the terminal device 2 the right to use the mobile body 100 or manages the reservation for use of the mobile body 100 in response to the request of the terminal device 2. For example, the management device 10 generates and manages schedule information that associates the identification information of the pre-registered user with the date and time of the reservation for use of the mobile body 100.

[0033] [Information providing device]

[0034] The information providing device 20 provides the location of the mobile body 100, the area where the mobile body 100 moves, and map information of the surrounding area to the mobile body 100. The information providing device 20 may also generate a route to the destination of the mobile body 100 in response to a request from the mobile body 100, and provide the generated route to the mobile body 100.

[0035] [Mobile body]

[0036] The mobile object 100 is used by the user in the following usage forms. Figure 2It is a diagram for explaining an example of the use form of the mobile body 100. The mobile body 100 is configured, for example, at a specified position of a facility or a street. When a user wants to use the mobile body 100, he can operate the operation unit (not shown) of the mobile body 100 to start the use, or operate the terminal device 2 to start the use of the mobile body 100. For example, when the user goes out to buy things and has a lot of goods, he starts to use the mobile body 100 and puts the goods into the storage unit of the mobile body 100. And the mobile body 100 moves with the user in a manner of autonomously following the user. The user can continue shopping or go to the next destination while storing the goods in the mobile body 100. For example, the mobile body 100 moves with the user on the sidewalk or the crosswalk of the road. The mobile body 100 can move in areas where pedestrians can pass, such as roads and sidewalks. For example, the mobile body 100 can be used in indoor or outdoor facilities, private land, such as shopping malls, airports, parks, theme parks, etc., and can also move in areas where pedestrians can pass.

[0037] The moving object 100 may be capable of autonomously moving in a mode such as a guidance mode or an emergency mode in addition to (or instead of) the following mode in which the moving object 100 follows the user as described above.

[0038] Figure 3 is a diagram for explaining the guidance mode. The guidance mode is a mode for guiding the user to the destination specified by the user. In this mode, the user is guided by autonomously moving in front of the user at the user's moving speed. Figure 3 As shown, in a shopping mall, when a user is looking for a specified commodity, if the user requests the mobile body 100 to be guided to the location of the specified commodity, the mobile body 100 guides the user to the location of the commodity. In this way, the user can easily find the specified commodity. It should be noted that when the mobile body 100 is used in a shopping mall, the mobile body 100 or the information providing device 20 maintains information such as the location of the commodity, the location of the store, the location of the facilities in the shopping mall, etc., which are associated with the map information, as well as the map information of the shopping mall. The map information includes detailed map information including the width of roads and passages, etc.

[0039] The emergency mode refers to a mode in which, in the event of an abnormality occurring to the user (e.g., a fall) during movement with the user, the mobile body 100 autonomously moves toward nearby people or facilities to seek help in order to help the user. In addition, the mobile body 100 may also move while maintaining a distance from the user in addition to following and guiding as described above (or instead of this).

[0040] Figure 4: is a perspective view showing the moving body 100. In the following description, the front direction of the moving body 100 is set as the positive x direction, the rear direction of the moving body 100 is set as the negative x direction, the width direction of the moving body 100 and the left direction based on the positive x direction is set as the positive y direction, the width direction of the moving body 100 and the right direction based on the positive x direction is set as the negative y direction, and the direction perpendicular to the x direction and the y direction and the height direction of the moving body 100 is set as the positive z direction.

[0041] The mobile body 100 includes, for example, a base 110, a door 112 provided on the base 110, and wheels (a first wheel 120, a second wheel 130, and a third wheel 140) assembled on the base 110. For example, a user can open the door 112 to put goods into or take goods out of the storage portion provided on the base 110. The first wheel 120 and the second wheel 130 are driving wheels, and the third wheel 140 is an auxiliary wheel (driven wheel). The mobile body 100 may also be able to move using a structure other than wheels, such as tracks.

[0042] A cylindrical support body 150 extending in the positive z direction is provided on the surface of the base body 110 in the positive z direction. A camera 180 for photographing the surroundings of the moving body 100 is provided at the end of the support body 150 in the positive z direction. The position where the camera 180 is provided may be any position different from the above.

[0043] The camera 180 is, for example, a camera capable of capturing images of the surroundings of the moving object 100 at a wide angle (eg, 360 degrees). The camera 180 may include a plurality of cameras. The camera 180 may be realized by combining a plurality of 120-degree cameras or a plurality of 60-degree cameras, for example.

[0044] Figure 5 FIG. 1 is a diagram showing an example of a functional configuration of the mobile object 100. The mobile object 100 includes Figure 4 In addition to the functional structure shown in the figure, the first motor 122, the second motor 132, the battery 134, the brake device 136, the steering device 138, the communication unit 190 and the control device 200 are further provided. The first motor 122 and the second motor 132 are operated by the power supplied by the battery 134. The first motor 122 drives the first wheel 120, and the second motor 132 drives the second wheel 130. The first motor 122 may be an in-wheel motor provided in the wheel portion of the first wheel 120, and the second motor 132 may be an in-wheel motor provided in the wheel portion of the second wheel 130.

[0045] The brake device 136 outputs a braking torque to each wheel based on an instruction from the control device 200. The steering device 138 includes an electric motor. The electric motor, for example, applies a force to a rack-and-pinion mechanism based on an instruction from the control device 200 to change the direction of the first wheel 120 or the second wheel 130, thereby changing the forward path of the moving body 100.

[0046] The communication unit 190 is a communication interface for communicating with the terminal device 2 , the management device 10 , or the information providing device 20 .

[0047] [Control device]

[0048] The control device 200 includes, for example, an identification unit 202, a path generation unit 204, a path determination unit 206, a drive control unit 208, and a storage unit 220. The identification unit 202, the path generation unit 204, the path determination unit 206, and the drive control unit 208 are implemented by, for example, a hardware processor such as a CPU (Central Processing Unit) executing a program (software). Some or all of these components can be implemented by hardware (including a circuit unit: circuitry) such as LSI (Large Scale Integration), ASIC (Application Specific Integrated Circuit), FPGA (Field-Programmable Gate Array), GPU (Graphics Processing Unit), etc., or can be implemented by the cooperation of software and hardware. The program can be pre-stored in a storage device such as an HDD (Hard Disk Drive) or a flash memory (a storage device having a non-temporary storage medium), or can be stored in a removable storage medium such as a DVD or CD-ROM (a non-temporary storage medium), and installed by assembling the storage medium in the drive device. The storage unit 220 is implemented by a storage device such as an HDD, a flash memory, or a RAM (Random Access Memory). The storage unit 220 stores map information 222 to be referred to by the mobile body 100. The map information 222 is, for example, map information such as the location of the mobile body 100, the area where the mobile body 100 moves, and the surrounding area provided by the information providing device 20. A part or all of the functional structure included in the control device 200 may also be included in other devices. For example, other devices may communicate with the mobile body 100 and cooperate to control the mobile body 100.

[0049] The recognition unit 202 recognizes the position (distance from the mobile body 100 and direction relative to the mobile body 100), speed, acceleration and other states of objects in the vicinity of the mobile body 100 based on the image captured by the camera 180, for example. Objects include traffic participants, obstacles existing in facilities and roads, etc. The recognition unit 202 recognizes and tracks the user of the mobile body 100. For example, the recognition unit 202 tracks the user based on an image captured of the user registered when the user uses the mobile body 100 (for example, a facial image of the user), and a facial image of the user provided by the terminal device 2 or the management device 10 (or a feature amount obtained from the facial image of the user). The recognition unit 202 recognizes gestures made by the user. It should be noted that a detection unit other than a camera, such as a radar device or LIDAR, may be provided in the mobile body 100. In this case, the recognition unit 202 recognizes the state of the vicinity of the mobile body 100 using the detection results of the radar device or LIDAR instead of (or in addition to) the image.

[0050] The path generation unit 204 generates a path to a destination based on the surrounding conditions of the mobile body 100 identified by the identification unit 202. Here, the so-called destination, when the mobile body 100 is in the following mode, indicates the user itself that is the following object, or a place within a specified range from the user. For example, the path generation unit 204 may set a specified place behind the user as the destination so that the mobile body 100 can be visually recognized from the user while the mobile body 100 follows the user. In addition, for example, the path generation unit 204 may determine the destination in a manner that keeps within a specified distance based on the walking speed of the user in order to prevent the mobile body 100 from being too far away from the user. In the case of the induction mode, the destination indicates, for example, the location of a commodity or facility set by the user. In this case, the user specifies the location of the commodity or facility, and the mobile body 100 compares the specified location of the commodity or facility with the map information 222. As a result of the comparison, the determined location of the commodity or facility is set as the destination. In addition, when the path generation unit 204 is in the induction mode, when the location set by the user is far from the current location of the mobile body 100, the location set by the user may be set as the final destination, and the location within the specified range from the current location may be set as the tentative destination. In addition, the induction mode does not necessarily require the user to set the destination, and the mobile body 100 may predict the direction of the user's movement and move autonomously in front of the user in accordance with the user's moving speed. At this time, the path generation unit 204 may also set the destination of the mobile body 100 to a location within the specified range in front of the user. The path is a path that the mobile body 100 can reasonably reach the destination by considering the front direction of the mobile body 100 (i.e., the x direction of the mobile body 100). For example, the distance to the destination, the time to reach the destination, the ease of passage of the path, etc. are fractionalized, and each score and a path with a score obtained by combining each score above a threshold are derived. The path can be generated by at least any algorithm that considers the front direction of the mobile body 100. Details of the processing performed by the path determination unit 206 will be described later.

[0051] The drive control unit 208 controls the motors (the first motor 122 and the second motor 132 ), the brake device 136 , and the steering device 138 so that the moving body 100 travels along the path generated by the path generation unit 204 .

[0052] [Regeneration of the path]

[0053] When the path generation unit 204 generates a path, the path determination unit 206 determines whether the generated path is within a specified area specified based on the current position and the destination of the mobile body 100. More specifically, the path determination unit 206 determines whether the generated path is within an area that represents a range within a specified distance from a reference line connecting the current position and the destination of the mobile body 100 as a specified area. That is, the specified area can be said to be a determination area for determining whether the path generated by the path generation unit 204 is an inefficient path in terms of reaching the destination from the current position of the mobile body 100.

[0054] Figure 6 FIG. 2 is a diagram showing an example of a path generated by the path generation unit 204. Figure 6 In FIG. 1 , reference numeral TP1 indicates a path to the destination G generated by the path generation unit 204, reference numeral CL indicates a reference line connecting the current position of the moving body 100 and the destination, and reference numeral d indicates a specified distance for defining a specified area. That is, the path determination unit 206 determines whether the generated path TP1 is within a specified area, which is an area within a range of a distance d from the reference line RL. Figure 6 In the case of , the predetermined area indicates an area surrounded by straight lines L1 and L2 separated from the reference line RL by a predetermined distance d, and the path determination unit 206 determines that the generated path TP1 deviates from the predetermined area.

[0055] When the path determination unit 206 determines that the generated path TP1 is out of the predetermined area, the drive control unit 208 rotates the moving body 100 locally by a predetermined angle, and the path generation unit 204 generates a path again from the moving body 100 rotated locally to the destination G. The predetermined angle in this case is, for example, an arbitrary angle that reduces the angular difference between the forward direction (x direction) of the moving body 100 and the direction toward the destination G, or an angle for making these directions consistent.

[0056] Figure 7 2 is a diagram showing an example of a route regenerated by the route generation unit 204 . Figure 7 As an example, the following situation is shown: Figure 6 In the scene shown, the moving body 100 rotates on the spot, and the path generation unit 204 regenerates the path TP2 from the moving body 100 that rotates on the spot to the destination G. When the path generation unit 204 regenerates the path, the path determination unit 206 determines whether the regenerated path is within the above-mentioned specified area. When the path determination unit 206 determines that the regenerated path is within the above-mentioned specified area, the drive control unit 208 controls the moving body 100 so that the moving body 100 moves to the destination along the regenerated path. Figure 7, the newly generated path TP2 is within the specified area, so the drive control unit 208 moves the moving body 100 along the path TP2 to the destination G. In this way, it is possible to prevent the moving body 100 from moving along the path TP1 that is inefficient (roundabout) for the moving body 100 and move the moving body 100 along the more efficient path TP2.

[0057] It should be noted that there may be a case where, even when a path is regenerated, the regenerated path may not be within the prescribed area due to the presence of obstacles and the like, and may be an inefficient path for the moving body 100. Therefore, as described below, when the regenerated path again deviates from the prescribed area, the drive control unit 208 controls the moving body 100 so that the moving body 100 moves along the regenerated path to the vicinity of the boundary of the prescribed area and rotates the moving body 100 in situ in the vicinity of the boundary of the prescribed area. Thereafter, the path generation unit 204 generates a path from the moving body 100 that has rotated in situ to the destination.

[0058] Figure 8 This is a diagram for explaining processing executed when the route regenerated by the route generation unit 204 deviates from the predetermined area. Figure 8 As an example, the following situation is shown: Figure 6 In the scene shown in FIG. 1 , the moving body 100 rotates on the spot, and the path generation unit 204 regenerates a path TP3 from the moving body 100 after the local rotation to the destination G. When the path generation unit 204 regenerates the path TP3, the path determination unit 206 determines whether the regenerated path TP3 is within the above-mentioned predetermined area. Figure 8 , the path determination unit 206 determines that the regenerated path TP3 is out of the prescribed area. Therefore, the drive control unit 208 moves the moving body 100 along the regenerated path to a point P near the boundary of the prescribed area, and the drive control unit 208 rotates the moving body 100 on the spot at the point P. The point P in this case is defined as, for example, a point on the regenerated path and separated from the boundary of the prescribed area by a predetermined distance.

[0059] Fig. 9 This is another diagram for explaining processing executed when the route regenerated by the route generation unit 204 deviates from the predetermined area. Fig. 9 As an example, the following situation is shown: Figure 8 In the scenario shown, the moving body 100 moves to a location P, performs an on-site rotation at the location P, and the path generation unit 204 regenerates a path TP4 from the moving body 100 after the on-site rotation to the destination. When the path generation unit 204 regenerates the path TP4, the path determination unit 206 determines whether the regenerated path TP4 is within the above-mentioned predetermined area. Figure 8 , the path determination unit 206 determines that the regenerated path TP4 is within the predetermined area. Therefore, the drive control unit 208 moves the moving body 100 along the regenerated path TP4 to the destination G. Thus, the processing performed by the control device 200 ends.

[0060] It should be noted that in Fig. 9 In the example, after the moving body 100 moves to the point P near the border, the path determination unit 206 determines the path based on the path of the moving body 100. Figures 6 to 8 As another method, the path determination unit 206 may redefine the reference line RL from the location after the movement to the destination G each time the moving body 100 moves, and define the specified area based on the redefined reference line RL, and then make the determination again.

[0061] [Processing flow]

[0062] Below, refer to Fig.10 The flow of processing executed by the control device 200 will be described. Fig.10 This is a flowchart showing an example of the flow of processing executed by the control device 200 . Fig.10 The illustrated process is repeatedly executed while the vehicle 100 is traveling in the following mode or the inducing mode.

[0063] First, the recognition unit 202 recognizes the surrounding conditions of the moving body 100 based on at least an image obtained by capturing the surrounding conditions of the moving body 100 (step S100). Next, the route generation unit 204 generates a route from the moving body 100 to the destination based on the recognized surrounding conditions and the set destination (step S102).

[0064] Next, the route determination unit 206 determines whether the generated route is within a specified area specified based on the current position and destination of the moving body 100 (step S104). If it is determined that the generated route is within the specified area, the drive control unit 208 causes the moving body 100 to travel along the route generated by the route generation unit 204 (step S110).

[0065] On the other hand, when it is determined that the generated path deviates from the specified area, the drive control unit 208 rotates the moving body 100 on the spot by a specified angle, and the path generation unit 204 generates a path to the destination again (step S106). Next, the path determination unit 206 determines whether the regenerated path is within the specified area (step S108). When it is determined that the regenerated path is within the specified area, the drive control unit 208 causes the moving body 100 to travel along the path regenerated by the path generation unit 204 (step S110). On the other hand, when it is determined that the generated path deviates from the specified area, the drive control unit 208 moves the moving body 100 to the vicinity of the boundary of the specified area. Thereafter, the control device 200 returns the processing to step S106. Thus, the processing of this flowchart ends.

[0066] It should be noted that, in the present embodiment, as an example, a case where the destination is given only as a location is described. However, the present invention is not limited to such a structure, and the above-mentioned control can also be applied even in the case where the destination is given as a combination of a location and the habitual orientation of the moving body. In the case where the habitual orientation of the moving body that becomes the target is given in addition to the location, the path generated or regenerated by the path generation unit 204 may repeatedly deviate from the specified area (fail for more than a specified number of times for regeneration). In this case, the control device 200 may also use the habitual orientation of the moving body 100 at the current position to overwrite the habitual orientation of the moving body that becomes the target (or temporarily cancel the target related to the habitual orientation of the moving body 100), and after reaching the target location, the drive control unit 208 rotates the moving body 100 on the spot to match the habitual orientation of the moving body that becomes the target.

[0067] Moreover, in the present embodiment, when the path regenerated by the path determination unit 206 deviates from the prescribed area, the drive control unit 208 moves the moving body 100 to the vicinity of the boundary. However, the present invention is not limited to such a structure, and the drive control unit 208 may also move the moving body 100 to the vicinity of the boundary of the prescribed area along the generated path and rotate on the spot when the path generated by the path determination unit 206 (that is, not the regenerated path but the path generated for the first time) deviates from the prescribed area. Thereafter, the path generation unit 204 generates the path again, and the path determination unit 206 determines whether the regenerated path is within the prescribed area. That is, when Fig.10 In the flowchart of , when a negative determination is obtained in step S104, the process of step S110 is executed, and thereafter, the processes of steps S106 and S108 are executed.

[0068] According to the present embodiment described above, when the path generated by the path generation unit 204 deviates from the prescribed area, the path is generated again after the moving body 100 is rotated on the spot, and when the regenerated path is within the prescribed area, the moving body 100 is moved along the path. Thus, when generating a path toward a destination, it is possible to prevent a path that is not efficient in accordance with the robot's usual direction from being generated.

[0069] The above-described embodiment can be expressed as follows.

[0070] A control device for a mobile object, comprising:

[0071] a storage medium storing computer-readable instructions; and

[0072] a processor connected to the storage medium,

[0073] The processor executes the computer-readable instructions to:

[0074] recognizing the surrounding conditions of the moving body based at least on an image obtained by photographing the surrounding conditions of the moving body;

[0075] generating a route from the moving object to the destination based on the identified surrounding conditions and the set destination;

[0076] determining whether the generated path is within a prescribed area prescribed based on the current position of the moving body and the destination;

[0077] controlling the moving object so that the moving object moves to the destination along the generated path; and

[0078] When it is determined that the route deviates from the predetermined area, the moving body is rotated on the spot, and a route from the moving body rotated on the spot to the destination is generated again.

[0079] Although specific embodiments of the present invention have been described above using the embodiments, the present invention is not limited to such embodiments at all, and various modifications and substitutions can be made without departing from the gist of the present invention.

Claims

1. A control device for a mobile object, wherein: The control device of the mobile body comprises: a recognition unit that recognizes the surrounding conditions of the moving body based on at least an image obtained by capturing the surrounding conditions of the moving body; a generating unit that generates a route from the moving object to the destination based on the recognized surrounding conditions and the set destination; a determination unit that determines whether the generated route is within a specified area specified based on the current position of the moving body and the destination; as well as a control unit that controls the moving body so that the moving body moves to the destination along the generated path, When it is determined that the route deviates from the predetermined area, the control unit rotates the moving body in place, and the generation unit regenerates the route from the moving body that has rotated in place to the destination.

2. The control device for a moving object according to claim 1, wherein: The determination unit determines whether the regenerated path is within the predetermined area. When it is determined that the regenerated route is within the predetermined area, the control unit controls the moving body so that the moving body moves to the destination along the regenerated route.

3. The control device for a moving object according to claim 1, wherein: The determination unit determines whether the regenerated path is within the predetermined area. When it is determined that the regenerated path deviates from the specified area, the control unit controls the moving body so that the moving body moves along the regenerated path to the vicinity of the boundary of the specified area, and rotates the moving body in situ near the boundary of the specified area, and the generation unit generates a path from the moving body after the in-situ rotation to the destination.

4. The control device for a moving object according to claim 1, wherein: The predetermined area is an area indicating a range within a predetermined distance from a reference line connecting the current position of the moving body and the destination.

5. The control device for a moving object according to claim 1, wherein: The moving body operates in any one of a following mode in which the moving body moves to follow the user and an induction mode in which the moving body moves ahead of the user in accordance with the moving speed of the user.

6. The control device for a moving object according to claim 5, wherein: When the mobile object operates in the following mode, the destination is the user or a point within a predetermined range from the user.

7. The control device for a moving object according to claim 5, wherein: When the moving object operates in the induction mode, the destination is a point set by the user or a point within a predetermined range in front of the user.

8. The control device for a moving object according to claim 5, wherein: When the moving object is operating in the induction mode, the destination is a temporary point that is temporarily set in order to reach a final point set by the user.

9. A method for controlling a moving object, wherein: The control method of the mobile body causes the computer to perform the following processing: recognizing the surrounding conditions of the moving body based at least on an image obtained by photographing the surrounding conditions of the moving body; generating a route from the moving object to the destination based on the identified surrounding conditions and the set destination; determining whether the generated path is within a prescribed area prescribed based on the current position of the moving body and the destination; controlling the moving object so that the moving object moves to the destination along the generated path; as well as When it is determined that the route deviates from the predetermined area, the moving body is rotated on the spot, and a route from the moving body rotated on the spot to the destination is generated again.

10. A storage medium storing a program, wherein: The program causes the computer to perform the following processing: recognizing the surrounding conditions of the moving body based at least on an image obtained by photographing the surrounding conditions of the moving body; generating a route from the moving object to the destination based on the identified surrounding conditions and the set destination; determining whether the generated path is within a prescribed area prescribed based on the current position of the moving body and the destination; controlling the moving object so that the moving object moves to the destination along the generated path; as well as When it is determined that the route deviates from the predetermined area, the moving body is rotated on the spot, and a route from the moving body rotated on the spot to the destination is generated again.

Citation Information

Patent Citations

  • Mobile robot

    JP2012111011A