Autonomous mobile device, route calculation method, and program
Patent Information
- Application Number
- JP2023073612
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-04-27
- Publication Date
- 2024-11-08
AI Technical Summary
【0009】 本発明によれば、自律移動体装置がユーザを同伴して移動する場合に対応して適切に移動できるようになるとの効果が得られる。
Smart Images

Figure 2024158423000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to an autonomous mobile device, a route calculation method, and a program. [Background technology]
[0002] A technology is known in which a person being guided can move a guide robot by grasping a handle attached to the guide robot and operating the handle to apply force in three axial directions (see, for example, Patent Document 1). [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2017-4102 A Summary of the Invention [Problem to be solved by the invention]
[0004] For example, when guiding a guided person to a destination by having them travel with an autonomous mobile device capable of moving autonomously, it is necessary to enable the autonomous mobile device to move appropriately depending on the situation when the guided person is present in the vicinity of the autonomous mobile device, for example, so that not only the autonomous mobile device but also the guided person do not come into contact with surrounding obstacles.
[0005] In consideration of the above-mentioned problems, an object of the present invention is to enable an autonomous mobile device to move appropriately in response to a case where the autonomous mobile device moves accompanied by a user. [Means for solving the problem]
[0006] One aspect of the present invention that solves the above-mentioned problems is an autonomous mobile device that includes a position measurement unit that measures the position of an accompanying mobile device that moves together with the autonomous mobile device while maintaining a predetermined distance from the autonomously moving autonomous mobile device, a first reference point calculation unit that calculates a first reference point corresponding to the accompanying mobile device based on the position of the accompanying mobile device measured by the position measurement unit, a first occupancy range calculation unit that calculates a first occupancy range corresponding to the accompanying mobile device based on the position of the accompanying mobile device measured by the position measurement unit, a third occupancy range calculation unit that calculates a third occupancy range when the autonomous mobile device moves together with the accompanying mobile device based on the first occupancy range and a second occupancy range corresponding to the autonomous mobile device, a third reference point calculation unit that calculates a third reference point corresponding to the third occupancy range, and a route planning unit that plans a route for the autonomous mobile device based on the third occupancy range and the third reference point.
[0007] One aspect of the present invention is a route calculation method for calculating a route for an autonomous mobile device to move, the method including: a position measurement step in which a position measurement unit uses a sensor to measure the position of an accompanying mobile device that moves together with the autonomous mobile device while maintaining a distance within a predetermined range from the autonomous mobile device that moves autonomously; a first reference point calculation step in which a first reference point calculation unit calculates a first reference point corresponding to the accompanying mobile device based on the position of the accompanying mobile device measured by the position measurement step; and a first occupancy range calculation step in which a first occupancy range calculation unit calculates a first reference point corresponding to the accompanying mobile device based on the position of the accompanying mobile device measured by the position measurement step. The route calculation method includes a first occupancy range calculation step of calculating a first occupancy range corresponding to a companion moving body, a third occupancy range calculation step of a third occupancy range calculation unit of calculating a third occupancy range when the autonomous mobile device moves together with the companion moving body based on the first occupancy range and a second occupancy range corresponding to the autonomous mobile device, a third reference point calculation step of a third reference point calculation unit of calculating a third reference point corresponding to the third occupancy range, and a route planning step of a route planning unit of planning a route for the autonomous mobile device based on the third occupancy range and the third reference point.
[0008] One aspect of the present invention is a program for causing a computer to function as a position measurement unit that measures the position of an accompanying moving body that moves together with an autonomous moving autonomous moving device while maintaining a predetermined distance from the autonomous moving autonomous moving device, a first reference point calculation unit that calculates a first reference point corresponding to the accompanying moving body based on the position of the accompanying moving body measured by the position measurement unit, a first occupancy range calculation unit that calculates a first occupancy range corresponding to the accompanying moving body based on the position of the accompanying moving body measured by the position measurement unit, a third occupancy range calculation unit that calculates a third occupancy range when the autonomous mobile device moves together with the accompanying moving body based on the first occupancy range and a second occupancy range corresponding to the autonomous mobile device, a third reference point calculation unit that calculates a third reference point corresponding to the third occupancy range, and a route planning unit that plans a route for the autonomous mobile device based on the third occupancy range and the third reference point. Effect of the Invention
[0009] According to the present invention, it is possible to obtain an effect that an autonomous mobile device can move appropriately in response to a case where the autonomous mobile device moves accompanied by a user. [Brief description of the drawings]
[0010] [Figure 1] 1 is a diagram showing an example of the appearance of an autonomous mobile device according to an embodiment of the present invention; [Diagram 2] 1 is a diagram showing an example of the appearance of an autonomous mobile device according to an embodiment of the present invention; [Diagram 3] 1 is a diagram showing an example of a route planned by an autonomous mobile device in this embodiment based on a mobile body occupation range and a mobile body reference point defined for the autonomous mobile device itself. FIG. [Figure 4] 11A and 11B are diagrams illustrating an example of a method for setting an accompaniment correspondence occupancy range and an accompaniment correspondence reference point in this embodiment. [Diagram 5] 1 is a diagram showing an example of a manner in which an autonomous mobile device in this embodiment moves along an accompaniment-compatible route. [Figure 6] FIG. 2 is a diagram illustrating an example of a functional configuration of an autonomous mobile device according to the present embodiment. [Figure 7]11 is a diagram showing an example of a processing procedure executed by an autonomous mobile device in the present embodiment in relation to planning an accompaniment-compatible route. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0011] <Embodiment> [External appearance of autonomous mobile device] The autonomous mobile device of the present embodiment will be described below. In the following description, the autonomous mobile device of the present embodiment will be described as being used to guide a visually impaired user to a desired destination in various facilities such as a museum or a hospital. The autonomous mobile device of this embodiment has a handle-shaped handle. By holding the handle and walking along with the movement of the autonomous mobile device moving to a destination, the user can be guided to the destination by the autonomous mobile device.
[0012] An example of the external appearance of the autonomous mobile device 100 of this embodiment will be described with reference to Fig. 1 and Fig. 2. Fig. 1 is a perspective view of the autonomous mobile device 100 as seen from the front left side. Fig. 2 is a perspective view of the autonomous mobile device 100 as seen from the rear left side.
[0013] A grip unit 150 is provided on the right side surface of the main body of the autonomous mobile device 100. The grip unit 150 is a portion that is held by a user who wishes to receive guidance, and the user is adapted to hold the grip unit 150 with, for example, the left hand. By holding the grip unit 150, the user can walk while following the movement of the autonomous mobile device 100.
[0014] Furthermore, the grip unit 150 is provided with a force sensor, which allows the user to operate the grip unit 150 by applying force in any direction. The grip unit 150 may also be provided with a predetermined number of buttons. The user can cause the autonomous mobile device 100 to execute a predetermined operation by applying force to the grip unit 150 in any direction, including the front, back, left, and right, or by pressing a button.
[0015] The autonomous mobile device 100 in the figure is provided with two front wheels 131-L, 131-R corresponding to the left and right, and two rear wheels 132-L, 132-R corresponding to the left and right. In this case, of the front wheels 131-L, 131-R and the rear wheels 132-L, 132-R, the front wheels 131-L, 131-R may be steered wheels, and the rear wheels 132-L, 132-R may be driven wheels.
[0016] The autonomous mobile device 100 is also provided with a speaker 131. The autonomous mobile device 100 can output voice or electronic sounds from the speaker 131 to the user to provide various notifications.
[0017] Furthermore, two-dimensional sensors 111-1 and 111-2 are provided in the autonomous mobile device 100. The two-dimensional sensor 111-1 is provided on the front left of the autonomous mobile device 100, and the two-dimensional sensor 111-2 is provided on the rear right of the autonomous mobile device 100. In other words, the two-dimensional sensors 111-1 and 111-2 are provided diagonally in the planar direction of the autonomous mobile device 100.
[0018] A two-dimensional sensor 111-1 provided on the left front side of the autonomous mobile device 100 detects the two-dimensional shape of the surroundings from the left lateral direction to the front of the autonomous mobile device 100. A two-dimensional sensor 111-2 provided on the right rear side of the autonomous mobile device 100 detects the two-dimensional shape of the surroundings from the right lateral direction to the rear of the autonomous mobile device 100.
[0019] The two-dimensional sensors 111-1 and 111-2 may use LiDAR (Light Detection and Ranging). That is, the two-dimensional sensors 111-1 and 111-2 each include a laser light emitting unit and a light receiving unit that receives the reflected laser light, and measure the distance based on the time from when the emitting unit irradiates the surroundings with pulsed laser light until the light receiving unit receives the reflected light. The autonomous mobile device 100 uses the measurement results to generate surrounding environment data indicating the shape of the surrounding environment, and estimates its own position on, for example, an area map. The area map is, for example, a robot map of facilities, buildings, etc. through which the autonomous mobile device 100 moves.
[0020] Furthermore, ultrasonic sensors 112-L and 112-R are provided on the left and right sides of the front of the autonomous mobile device 100. The ultrasonic sensors 112-L and 112-R radiate ultrasonic waves to the surroundings, measure the time it takes for the radiated ultrasonic waves to reflect and return, and measure the distance to a surrounding object based on the measured time. The ultrasonic sensors 112-L and 112-R assist the two-dimensional sensors 111-1 and 111-2 in detecting the two-dimensional shape of the surroundings. In other words, it is difficult for the two-dimensional sensors 111-1 and 111-2 using LiDAR to detect the shape of the surroundings where light passes through. Therefore, the ultrasonic sensors 112-L and 112-R are configured to detect the shape of the light-passing parts. By correcting the two-dimensional shape detected by two-dimensional sensors 111-1 and 111-2 using the two-dimensional shape detected by ultrasonic sensors 112-L and 112-R, it is possible to accurately grasp the surrounding two-dimensional shape, including areas that do not transmit light as well as areas that transmit light.
[0021] The autonomous mobile device 100 is also provided with a three-dimensional sensor 113. The three-dimensional sensor 113 detects the three-dimensional shape of a surrounding object. LiDAR (Light Detection and Ranging) may also be used for the three-dimensional sensor 113. The three-dimensional sensor 113 may also be used to assist in detecting the shape of the surrounding environment.
[0022] The autonomous mobile device 100 is also provided with a depth camera 114. The depth camera 114 can be used, for example, to detect steps in the surrounding environment.
[0023] [Path planning for autonomous mobile devices] The autonomous mobile device 100 of this embodiment stores an area map, and plans a route from the current position to the destination on the area map. 3 shows a route RT planned by the autonomous mobile device 100 based on a mobile object occupation range BD1 and a mobile object reference point p1 defined for the autonomous mobile device 100. The mobile object occupation range BD1 is an area range on a plane that is treated as being occupied by the autonomous mobile device 100 in route planning. In this case, the autonomous mobile device 100 plans a route RT so that the mobile occupation range BD1 does not come into contact with surrounding objects. The route RT in this case corresponds to a trajectory that should be aligned with the mobile reference point p1 of the autonomous mobile device 100 when the autonomous mobile device 100 moves. In the figure, an example is shown in which the route RT is planned so as not to come into contact with the wall WL.
[0024] When the autonomous mobile device 100 moves autonomously without accompanying the user U, there is no particular problem in planning the route RT as shown in FIG. On the other hand, when the autonomous mobile device 100 moves with the user U, the user U holds the handle 150 provided on the right side surface of the autonomous mobile device 100 with, for example, the left hand and positions himself / herself near the autonomous mobile device 100. In this case, in the route RT planned as shown in FIG. 3, the user occupancy range BD2 determined corresponding to the user U overlaps with the wall WL. The fact that the user occupancy range BD2 overlaps with the wall WL indicates that the user U moving accompanied by the autonomous mobile device 100 may come into contact with the wall WL. In other words, it is difficult to appropriately guide the user U with the route RT planned as shown in FIG. 3. Therefore, the autonomous mobile device 100 of this embodiment is configured to be able to plan a route that prevents the user U from coming into contact with surrounding objects. Hereinafter, a route planned so that the user U does not come into contact with surrounding objects is also referred to as an accompaniment-compatible route.
[0025] [Example of method for setting accompaniment-compatible occupancy range and accompaniment-compatible reference point] When formulating an accompaniment-compatible route, the autonomous mobile device 100 sets an accompaniment-compatible occupancy range that includes the occupancy range of the autonomous mobile device 100 and the occupancy range of the user U, and an accompaniment-compatible reference point that corresponds to the accompaniment-compatible occupancy range. The autonomous mobile device 100 plans an accompaniment-compatible route through which the accompaniment-compatible reference point should pass so that the accompaniment-compatible occupancy area does not come into contact with surrounding objects. In other words, in order to plan an accompaniment-compatible route, it is sufficient to appropriately determine the accompaniment-compatible occupancy area and the accompaniment-compatible reference point.
[0026] An example of a method for setting the accompanying-compatible occupancy range and the accompanying-compatible reference point will be described with reference to Fig. 4. As the setting of the accompanying-compatible occupancy range and the accompanying-compatible reference point, the autonomous mobile device 100 may be configured to move for a predetermined time or a predetermined distance for calibration prior to guidance, with the user U accompanying the user U holding the handle unit 150, so that a certain number of samples are obtained for the position of the feet of the user U. It is preferable that the movement during the calibration be linear. Alternatively, the autonomous mobile device 100 may be configured to measure the position of the user U's feet when traveling accompanied by the user U for guidance purposes, for example, and set an accompaniment-compatible occupancy range and an accompaniment-compatible reference point. In the following description, a case will be taken as an example in which, prior to guidance, the autonomous mobile device 100 moves for a predetermined time or a predetermined distance accompanied by the user U to perform calibration.
[0027] While the autonomous mobile device 100 is moving for a predetermined time or a predetermined distance in the direction indicated by arrow A with the user U accompanying it, the autonomous mobile device 100 uses the two-dimensional sensor 111-2 to measure the positions of the right and left feet of the user U who is walking while accompanying the autonomous mobile device 100. FIG. 4 shows a measurement position group fp-L, which is a set of measured positions of the left foot, and a measurement position group fp-R, which is a set of measured positions of the right foot. The autonomous mobile device 100 calculates a left foot corresponding reference point p11-L that is treated as a reference for the left foot based on the position of the left foot included in the measurement position group fp-L. The left foot corresponding reference point p11-L may be calculated by calculating, for example, the center of gravity of the position of the left foot included in the measurement position group fp-L. Furthermore, the autonomous mobile device 100 calculates a right-foot corresponding reference point p11-R that is treated as a reference for the right foot, based on the position of the right foot in the measurement position group fp-R. The right-foot corresponding reference point p11-R may be calculated by calculating the center of gravity of the position of the right foot included in the measurement position group fp-R, for example.
[0028] Next, the autonomous mobile device 100 calculates a user reference point p12 corresponding to the user U based on the calculated left foot corresponding reference point p11-L and right foot corresponding reference point p11-R. The example in Fig. 4 shows an example in which the autonomous mobile device 100 calculates the midpoint of a line connecting the left foot corresponding reference point p11-L and the right foot corresponding reference point p11-R as the user reference point p12.
[0029] Furthermore, the autonomous mobile device 100 calculates an occupied range (user occupied range) BD2 of the user U based on the calculated left foot corresponding reference point p11-L and right foot corresponding reference point p11-R. In the example of Fig. 4, the autonomous mobile device 100 sets the user occupied range BD2 to a range surrounded by a circumference including the left foot corresponding reference point p11-L and the right foot corresponding reference point p11-R, centered on the user reference point p12 calculated as described above based on the left foot corresponding reference point p11-L and the right foot corresponding reference point p11-R.
[0030] The autonomous mobile device 100 calculates an accompaniment-compatible occupancy range that includes a mobile object occupancy range BD1 of the autonomous mobile device 100 and a user occupancy range BD2 of the user U. The mobile object occupancy range BD1 of the autonomous mobile device 100 is determined in advance according to the size of the autonomous mobile device 100 in the planar direction, and may be stored in the autonomous mobile device 100. Note that a plurality of different setting contents may be prepared for the mobile object occupancy range BD1, and a selection may be made according to, for example, the usage environment of the autonomous mobile device 100. Figure 4 shows an example in which two common tangents Ln-1, Ln-2 are set for the moving object occupied area BD1 and the user occupied area BD2, each of which is a circumference, and the area defined by the outer contour formed by the arc in the moving object occupied area BD1, the arc in the user occupied area BD2, and the common tangents Ln-1, Ln-2 is set as the accompaniment-compatible occupied area.
[0031] In addition, the autonomous mobile device 100 calculates an accompanying correspondence reference point corresponding to the accompanying correspondence occupancy range. In Fig. 4, an example is shown in which the autonomous mobile device 100 calculates the midpoint of a line connecting the mobile body reference point p1 of the autonomous mobile device 100 and the user reference point p12 of the user U as the accompanying correspondence reference point p21.
[0032] The calculation method of the accompanied corresponding reference point p21 is not limited to the example shown in the figure. For example, the autonomous mobile device 100 may calculate the center of gravity or the like obtained for the accompanied corresponding occupancy range as the accompanied corresponding reference point p21. In addition, the shape of the accompanied corresponding occupancy range is not particularly limited, and may be set as a polygon or a circle, and the calculation method of the accompanied corresponding reference point p21 may be appropriately changed depending on the shape of the accompanied corresponding occupancy range.
[0033] The autonomous mobile device 100 plans a route (accompanying route) for the autonomous mobile device 100 to reach the destination based on the accompanying occupancy range and the accompanying reference point p21 calculated in this manner. In other words, the autonomous mobile device 100 calculates the accompanying route as a line that should match the trajectory of the accompanying reference point p21 during movement so that the calculated accompanying occupancy range is kept at a certain distance or more from surrounding objects.
[0034] Fig. 5 shows a state in which the autonomous mobile device 100 moves through the same location as Fig. 3 along the accompaniment-compatible route RT2 set as described above. In the figure, when the autonomous mobile device 100 moves, a state in which the user occupation range BD2 corresponding to the accompanying user U is separated from the wall WL by a certain distance or more is ensured. In other words, in the figure, the accompaniment-compatible route RT2 of the autonomous mobile device 100 is set so that the user U accompanying the autonomous mobile device 100 does not come into contact with surrounding objects.
[0035] In addition, in this embodiment, when planning the accompaniment-compatible route RT2, information on the foot position measured when the accompanying user U moves in association with the autonomous mobile device 100 is used. The information on the foot position measured in this manner differs for each user U depending on the physique, body type, walking style, and the like. For this reason, in this embodiment, it is possible to plan an accompaniment-compatible route RT2 that is appropriate for the user U who actually walks in association with the autonomous mobile device 100.
[0036] [Example of functional configuration of autonomous mobile device] Fig. 6 shows an example of the functional configuration of the autonomous mobile device 100. The functions of the autonomous mobile device 100 shown in the figure are realized by a CPU included in the autonomous mobile device 100 as hardware executing a program. The autonomous mobile device 100 in the figure includes a sensor unit 101, a mobile mechanism unit 102, a user interface unit 103, a control unit 104, and a storage unit 105.
[0037] The sensor unit 101 includes a predetermined sensor that detects surrounding objects and obstacles and detects information for estimating the self-position. In correspondence with Fig. 1 and Fig. 2, the sensor unit 101 includes two-dimensional sensors 111-1 and 111-2, and ultrasonic sensors 112-L and 112-R. The sensor unit 101 may further include a three-dimensional sensor 113, a depth camera 114, and the like.
[0038] The movement mechanism unit 102 is a drive mechanism that enables movement of the autonomous mobile device 100. The movement mechanism unit 102 may be configured to be capable of moving the autonomous mobile device 100 forward or backward, as well as to change the direction to the left or right, based on information input from the user interface unit 103 or the control unit 104.
[0039] The user interface unit 103 includes a portion related to an input device that allows a user to perform operations. Specifically, the user interface unit 103 includes a grip unit 150 and a configuration that allows an operation of applying force to the grip unit 150 in the front, back, left and right directions using a force sensor. The user interface unit 103 also includes operators such as buttons provided on the grip unit 150 and the main body of the autonomous mobile device 100. Furthermore, the user interface unit 103 includes a portion that outputs information to the user. Specifically, the user interface unit 103 includes a speaker 131 (FIG. 1) as a portion that outputs information to the user, and a portion that causes the speaker to output sound.
[0040] The control unit 104 executes various controls in the autonomous mobile device 100. The control unit 104 includes a position measurement unit 141, a first reference point calculation unit 142, a first occupancy range calculation unit 143, a third occupancy range calculation unit 144, a third reference point calculation unit 145, a route planning unit 146, and a movement control unit 147.
[0041] When setting the accompanying corresponding occupancy range and the accompanying corresponding reference point, the position measurement unit 141 measures the positions of the left and right feet (an example of the position of the accompanying moving object) of the user U (an example of the accompanying moving object) based on the positions of the objects detected by the two-dimensional sensor 111-2 (and the ultrasonic sensor 112-R). Specifically, the positions of the left and right feet thus measured by the position measurement unit 141 are obtained as the measurement position groups fp-L and fp-R, respectively (FIG. 4).
[0042] The first reference point calculation unit 142 calculates a user reference point p12 (an example of a first reference point) of the user U based on the measurement position groups fp-L and fp-R measured by the position measurement unit 141. In correspondence with the example of FIG. 4, the first reference point calculation unit 142 first calculates two left-foot corresponding reference points p11-L and right-foot corresponding reference points p11-R corresponding to the measurement position groups fp-L and fp-R measured by the position measurement unit 141. The first reference point calculation unit 142 calculates the midpoint of a line connecting the calculated left-foot corresponding reference point p11-L and right-foot corresponding reference point p11-R as the user reference point p12.
[0043] The first occupancy range calculation unit 143 calculates a user occupancy range BD2 (an example of a first occupancy range) corresponding to the user U, based on the measurement position groups fp-L, fp-R measured by the position measurement unit 141. In correspondence with the example of Fig. 4, the first occupancy range calculation unit 143 is configured to obtain, as an occupancy range DB2, a circumference that is centered on the user reference point p12 and includes the left foot corresponding reference point p11-L and the right foot corresponding reference point p11-R.
[0044] The third occupancy range calculation unit 144 calculates an accompanying-compatible occupancy range (an example of a third occupancy range). In correspondence with the example of Fig. 4, the third occupancy range calculation unit 144 calculates an outer contour formed by setting common tangents Ln-1, Ln-2 to the user occupancy range BD2 corresponding to the user U calculated by the first occupancy range calculation unit 143 and the moving body occupancy range BD1 corresponding to the known autonomous mobile device 100, as the accompanying-compatible occupancy range. The moving body occupancy range BD1 corresponding to the autonomous mobile device 100 may be stored in the device parameter storage unit 151 as one of the device parameters.
[0045] The third reference point calculation unit 145 calculates an accompanying person corresponding reference point p21 (an example of a third reference point). Specifically, in correspondence with the example of Fig. 4, the third reference point calculation unit 145 calculates the midpoint of a line connecting the user reference point p12 of the user U calculated by the first reference point calculation unit 142 and a moving body reference point p1 (an example of a second reference point) of a known autonomous moving body device 100 as the accompanying person corresponding reference point p21.
[0046] The route planning unit 146 plans a route to a destination of the autonomous mobile device 100 traveling accompanied by the user U. The route planning unit 146 calculates a route RT as a line that should be a trajectory of the accompaniment corresponding reference point p21 when the autonomous mobile device 100 moves so that the accompaniment corresponding occupancy range does not overlap with surrounding objects indicated by the surrounding environment data generated based on the detection output of the sensor unit 101.
[0047] The movement control unit 147 controls the autonomous mobile device 100 to move so that the accompanied corresponding reference point p21 traces the route RT planned by the route planning unit 146. At this time, the movement control unit 147 may convert the route RT corresponding to the accompanied corresponding reference point p21 planned by the route planning unit 146 into a route corresponding to the moving object reference point p1 based on the distance between the reference point (moving object reference point) p1 of the autonomous mobile device 100 and the accompanied corresponding reference point p21, and control the movement of the autonomous mobile device 100 so that the moving object reference point p1 traces the route corresponding to the moving object reference point p1 after the conversion.
[0048] The storage unit 105 stores various types of information corresponding to the autonomous mobile device 100. The storage unit 105 includes a device parameter storage unit 151 and an area map storage unit 152.
[0049] The device parameter storage unit 151 stores predetermined parameters (device parameters) related to the autonomous mobile body device 100 used for autonomous movement control of the autonomous mobile body device 100. The device parameters include a mobile body reference point p1 corresponding to the autonomous mobile body device 100 and a mobile body occupation range BD1 corresponding to the autonomous mobile body device 100.
[0050] The area map storage unit 152 stores an area map indicating the area in which the autonomous mobile device 100 moves.
[0051] [Example of processing procedure] An example of a processing procedure executed by the autonomous mobile device 100 having the configuration shown in FIG. 6 in relation to planning an accompaniment-compatible route will be described with reference to the flowchart shown in FIG.
[0052] Step S100: In the calibration for planning an accompaniment-compatible route, as described above, the autonomous mobile device 100 is made to move linearly a predetermined distance accompanied by the user U. During the movement for the calibration, the position measurement unit 141 measures the positions of the left foot and the right foot of the user U based on the position of an object detected by the two-dimensional sensor 111-2, thereby obtaining measurement position groups fp-L and fp-R ( FIG. 4 ). Step S102: The first reference point calculation unit 142 calculates a left-foot corresponding reference point p11-L and a right-foot corresponding reference point p11-R by using the measurement position groups fp-L and fp-R obtained by the measurement in step S100. Step S104: The first reference point calculation unit 142 calculates a user reference point p12 by using the left foot corresponding reference point p11-L and the right foot corresponding reference point p11-R calculated in step S102. Step S106: The first occupation area calculation unit 143 calculates a user occupation area BD2 corresponding to the user U, based on the groups of measurement positions fp-L and fp-R measured in step S100. Step S108: The third occupation area calculation unit 144 acquires the moving object occupation area BD1 from the device parameter storage unit 151. Step S110: The third occupation area calculation unit 144 calculates the accompaniment-compatible occupancy area based on the user occupation area BD2 calculated in step S108 and the moving object occupation area BD1 acquired in step S108. Step S112: The third reference point calculation unit 145 acquires the moving object reference point p1 from the device parameter storage unit 151. Step S114: The third reference point calculation unit 145 calculates an accompanying object reference point p21, based on the user reference point p12 calculated in step S104 and the moving object reference point p1 acquired in step S112.
[0053] Step S116: The route planning unit 146 plans an accompaniment-compatible route based on the accompaniment-compatible occupancy area calculated in step S110 and the accompaniment-compatible reference point calculated in step S114.
[0054] [supplementary explanation] The autonomous mobile device 100 of this embodiment may store, for example, facility deployment information and the like in a travel target area in the storage unit 105. In addition, the autonomous mobile device 100 may output various kinds of guidance by voice from the speaker 131 while traveling to a destination accompanied by the user U. For example, the autonomous mobile device 100 may provide voice guidance at a predetermined timing regarding the distance to the destination or to a waypoint on the way to the destination. The autonomous mobile device 100 may also provide voice guidance that the destination or the waypoint has been reached. Furthermore, when a right turn, left turn, etc. is required while traveling along an escort-compatible route, the autonomous mobile device 100 may guide the user to turn right or left by voice. When turning right or left, a vibration rotor mounted on the handle unit 150 may be operated to notify the user. Furthermore, a notification that an obstacle exists ahead may be given by voice. Furthermore, when passing near a specific facility such as a toilet, guidance that the facility is there may be output by voice.
[0055] In addition, the following describes operations that can be performed by a user U accompanying the autonomous mobile device 100 and examples of the behavior of the autonomous mobile device 100 in response to the operations. In the following description, an example is given in which the handle unit 150 can be operated to apply force in four directions, front, back, left, and right, and two operators, a first button and a second button, are provided on the part of the handle unit 150 that is held by the user U. The autonomous mobile device 100 can transition between an autonomous movement mode, a destination selection mode, and a manual driving mode. In the autonomous movement mode, the autonomous mobile device 100 moves (drives) when the user U presses the first button, and stops when the state in which the first button is pressed is released. In the autonomous movement mode, the autonomous mobile device 100 changes the moving speed during movement in response to an operation of applying a force to the handle unit 150 in the forward and backward directions.
[0056] Furthermore, the autonomous mobile device 100 transitions to a destination selection mode in response to an operation of applying force to either the left or right side of the handle unit 150 while stopped in the autonomous movement mode. The destination selection mode is a mode in which a destination is set in response to a user operation. In the destination selection mode, the autonomous mobile device 100 outputs a plurality of destination candidates prepared in advance by voice in order each time an operation of applying force to the left or right is performed on the handle unit 150. Information on the destination candidates may be stored in the storage unit 105. The user U can switch between the destination candidates output by voice by applying force to the handle unit 150 from side to side. When a desired destination is output by voice as a destination candidate, the user U operates the first button. In response to the operation of the first button, the autonomous mobile device 100 sets the destination candidate that was output by voice in response to the timing when the first button was operated as a destination, and transitions to the autonomous movement mode.
[0057] Furthermore, in response to the operation of the second button in the destination selection mode, the autonomous mobile body device 100 transitions to a manual driving mode. In the manual driving mode, the user U can move the autonomous mobile body device 100 by operating the first button and the handle unit 150. Specifically, in the manual driving mode, the autonomous mobile device 100 drives (moves) while the first button is pressed. In the manual driving mode, the autonomous mobile device 100 drives forward in response to the user U applying force to the front of the handle portion 150 while pressing the first button, and drives backward in response to the user U applying force to the rear of the handle portion 150. Furthermore, the autonomous mobile device 100 turns left when the user U applies a force to the left without pressing the first button, and turns right when the user U applies a force to the right. When a force is applied to the left while pressing the first button, the autonomous mobile device 100 turns left while moving forward, and when a force is applied to the right, the autonomous mobile device 100 turns right while moving forward. When the second button is operated while the autonomous mobile device 100 is stopped in the manual driving mode, the autonomous mobile device 100 transitions to the destination selection mode.
[0058] <Modification> In Fig. 4, the user occupied area BD2 is calculated based on the positions of the left and right feet of the user U measured by the position measurement unit 141. The method of calculating the user occupied area BD2 is not limited to the example of Fig. 4. For example, the autonomous mobile device 100 may identify a height position where the planar area of the user U is largest based on the three-dimensional shape of the user U detected by the three-dimensional sensor 113, for example, and calculate the user occupied area BD2 based on the planar area of the user U at the identified height position.
[0059] 4, the moving object occupation area BD1 and the user occupation area BD2 are each circular in the planar direction. The shapes of the moving object occupation area BD1 and the user occupation area BD2 are not particularly limited, and may be, for example, an ellipse, a rectangle, or the like.
[0060] In this embodiment, a mobile object management server (mobile object management device) that manages the autonomous mobile object device 100 may be provided. The mobile object management server and the autonomous mobile object device 100 are communicably connected. In this case, the mobile object management server may have a function of executing at least one of the steps shown in FIG. 7 in response to the planning of an accompaniment-compatible route.
[0061] The configuration of this embodiment may also be applied to a case where the user U, as an accompanying moving body, walks following the autonomous moving body device 100 while keeping a certain distance from the autonomous moving body device 100 without gripping the handle unit 150. In this case, the handle unit 150 may be omitted, and the accompanying user U is not limited to a visually impaired person. Furthermore, the companion moving object is not limited to a person, but may be, for example, an animal or another autonomous moving device that moves together with the person.
[0062] In addition, all or part of the autonomous mobile device 100 in the above-mentioned embodiment may be realized by a computer. In that case, a program for realizing this function may be recorded in a computer-readable recording medium, and the program recorded in the recording medium may be read into a computer system and executed to realize the function. In addition, the "computer system" referred to here includes hardware such as an OS and peripheral devices. In addition, the "computer-readable recording medium" refers to a portable medium such as a flexible disk, an optical magnetic disk, a ROM, a CD-ROM, and a storage device such as a hard disk or SSD built into a computer system. Furthermore, the "computer-readable recording medium" may include a medium that dynamically holds a program for a short period of time, such as a communication line when a program is transmitted via a network such as the Internet or a communication line such as a telephone line, and a medium that holds a program for a certain period of time, such as a volatile memory inside a computer system that is a server or client in that case. In addition, the above-mentioned program may be a program for realizing a part of the above-mentioned function, and may further be a program that can realize the above-mentioned function in combination with a program already recorded in the computer system, or may be a program that is realized using a programmable logic device such as an FPGA.
[0063] The "Sustainable Development Goals (SDGs)" are 17 international goals that were adopted at the United Nations Summit in September 2015. The autonomous mobile control system according to this embodiment can contribute to the achievement of the 17 SDGs, for example, goal 9 "Build resilient infrastructure, promote industry, innovation and infrastructure." [Explanation of symbols]
[0064] 100 Autonomous mobile device, 101 Sensor unit, 102 Moving mechanism unit, 103 User interface unit, 104 Control unit, 105 Memory unit, 111-1 2D sensor, 111-2 2D sensor, 112-L Ultrasonic sensor, 112-R Ultrasonic sensor, 113 3D sensor, 114 Depth camera, 131 Speaker, 141 Position measurement unit, 142 First reference point calculation unit, 143 First occupancy range calculation unit, 144 Third occupancy range calculation unit, 145 Third reference point calculation unit, 146 Path planning unit, 147 Movement control unit, 150 Handle unit, 151 Device parameter memory unit, 152 Area map memory unit
Claims
1. a position measurement unit that measures a position of a companion moving body that moves together with an autonomous moving body device while maintaining a distance within a predetermined range from the autonomous moving body device; a first reference point calculation unit that calculates a first reference point corresponding to the accompanying moving object based on the position of the accompanying moving object measured by the position measurement unit; a first occupancy range calculation unit that calculates a first occupancy range corresponding to the accompanying moving object based on the position of the accompanying moving object measured by the position measurement unit; a third occupancy range calculation unit that calculates a third occupancy range when the autonomous mobile device moves together with the companion mobile device, based on the first occupancy range and a second occupancy range corresponding to the autonomous mobile device; a third reference point calculation unit that calculates a third reference point corresponding to the third occupancy range; a route planning unit that plans a route for the autonomous mobile device based on the third occupancy range and the third reference point; An autonomous mobile device comprising:
2. The position measurement unit measures the position of the foot of the accompanying moving body, which is a person, as the position of the accompanying moving body. The autonomous mobile device of claim 1 .
3. The first reference point calculation unit calculates a reference position of the accompanying moving object, which is a person, based on a group of measurement positions based on a plurality of foot positions obtained by measurement by the position measurement unit during a predetermined period. The autonomous mobile device according to claim 2 .
4. the position measurement unit measures the positions of a right foot and a left foot of the accompanying moving object which is a person; The first reference point calculation unit calculates a reference position of the accompanying moving object, which is a person, based on a group of measurement positions of a left foot and a group of measurement positions of a right foot obtained by measurement by the position measurement unit during a predetermined period. The autonomous mobile device according to claim 3 .
5. The third reference point calculation unit calculates the third reference point based on the first reference point and a second reference point corresponding to the autonomous mobile device. The autonomous mobile device according to claim 1 .
6. A route calculation method for calculating a route to be traveled by an autonomous mobile device, comprising the steps of: a position measurement step in which a position measurement unit measures, by using a sensor, a position of a companion moving body that moves together with an autonomous moving body device while maintaining a distance within a predetermined range from the autonomous moving body device; a first reference point calculation step in which a first reference point calculation unit calculates a first reference point corresponding to the accompanying moving object based on the position of the accompanying moving object measured in the position measurement step; a first occupancy range calculation step in which a first occupancy range calculation unit calculates a first occupancy range corresponding to the accompanying moving object based on the position of the accompanying moving object measured in the position measurement step; a third occupancy range calculation step in which a third occupancy range calculation unit calculates a third occupancy range when the autonomous mobile device moves together with the companion mobile device, based on the first occupancy range and a second occupancy range corresponding to the autonomous mobile device; a third reference point calculation step in which a third reference point calculation unit calculates a third reference point corresponding to the third occupancy range; a route planning step in which a route planning unit plans a route for the autonomous mobile device based on the third occupancy range and the third reference point; A route calculation method comprising:
7. Computer, a position measurement unit that measures the position of a companion moving body that moves together with an autonomous moving body device while maintaining a distance within a predetermined range from the autonomous moving body device; a first reference point calculation unit that calculates a first reference point corresponding to the accompanying moving object based on the position of the accompanying moving object measured by the position measurement unit; a first occupancy range calculation unit that calculates a first occupancy range corresponding to the accompanying moving object based on the position of the accompanying moving object measured by the position measurement unit; a third occupancy range calculation unit that calculates a third occupancy range when the autonomous mobile device moves together with the companion mobile device, based on the first occupancy range and a second occupancy range corresponding to the autonomous mobile device; a third reference point calculation unit that calculates a third reference point corresponding to the third occupancy range; a route planning unit that plans a route for the autonomous mobile device based on the third occupancy range and the third reference point; A program to function as a
Citation Information
Patent Citations
Walker tracking device, and walking support and carrying device using the same
JP2008210238A
Movable body
JP2019175333A
Travel device, robot for guidance, and control method of travel device
JP2017004102A
