The present invention relates to an information processing apparatus and a mobile robot.
Typically, various autonomously-runnable mobile robots such as a service robot or a home robot, specifically a cleaning robot, a security robot, a transfer robot, a guidance robot, a nursing-care robot, an agricultural robot, etc., have been in practical use. For example, a mobile robot autonomously running along a floor surface in running environment generally includes a distance sensor configured to measure a distance to a target object such as a floor surface or an obstacle for the purpose of sensing an obstacle, a step, etc. present in the running environment, and a distance measurement system using such a distance sensor has been proposed (see, e.g., Patent Literature 1).
The distance measurement system (an information processing apparatus) described in Patent Literature 1 includes a robot body (a mobile body) runnable along a floor surface by means of drive wheels, a distance sensor (a distance measurement sensor) configured to measure a distance to a target object in the front of the robot body in a running direction, and a control apparatus configured to control a drive unit of the drive wheels based on a measurement result of the distance sensor. The distance sensor includes a first distance measurement sensor for a short range and a second distance measurement sensor for a long range. Measurement data measured by each sensor is integrated such that a measurement area in the front in the running direction is expanded.
PATENT LITERATURE 1: JP-A-2014-21625
When the distance to the target object is measured by the distance sensor, if the posture of the mobile body changes due to, e.g., movement of the wheel over a protrusion on the floor surface, the posture change influences the measurement data of the distance sensor, and for this reason, the distance to the target object cannot be accurately measured. That is, in the typical distance measurement system described in Patent Literature 1, two distance sensors for the short range and the long range are provided, but measurement results of two distance sensors simultaneously change in association with the change in the posture of the mobile body. Thus, when the distance to the target object is calculated based on the measurement data obtained by two distance sensors, there is a probability that failure such as identification of the presence of, e.g., non-existent asperities or obstacle or neglecting of, e.g., existent asperities or obstacle is caused.
The present invention is intended to provide an information processing apparatus and a mobile robot configured so that influence of a change in the posture of a mobile body can be reduced and the accuracy of measurement of a distance to a target object can be improved.
The information processing apparatus of the present invention is an information processing apparatus for processing movement information on a mobile body moving along a predetermined surface in environment. The information processing apparatus includes a first distance sensor provided at the mobile body and configured to detect a distance to a first position on the predetermined surface, a second distance sensor provided at the mobile body and configured to detect a distance to a second position on the predetermined surface, and a control section configured to control the first distance sensor and the second distance sensor. The second position is set to a position closer to the mobile body than the first position is to along a movement direction of the mobile body. The control section includes a distance change acquisition unit configured to acquire changes in the distances, which are detected by the first distance sensor and the second distance sensor, to the first position and the second position, a distance change comparison unit configured to compare the changes, which are acquired by the distance change acquisition unit, in the distances to the first position and the second position, and a distance change distinguishing unit configured to distinguish, based on a comparison result obtained by the distance change comparison unit, a distance change due to a change in the posture of the mobile body and a distance change due to the shape of the predetermined surface.
According to such as aspect of the present invention, the distance change distinguishing unit distinguishes the distance change (a change with the same phase) due to the change in the posture of the mobile body and the distance change (a change with a phase difference) due to the shape of the predetermined surface in the environment from each other, and excludes the distance change due to the change in the posture of the mobile body while employing the distance change due to the shape of the predetermined surface in the environment. Thus, a target object such as asperities or an obstacle can be accurately detected. Thus, influence of the change in the posture of the mobile body on distance measurement can be reduced, and the accuracy of measurement of the distance to the target object on the predetermined surface, such as asperities or an obstacle, can be improved.
In the present invention, the first distance sensor preferably detects distances to multiple first positions set along a cross direction crossing the movement direction of the mobile body, and the second distance sensor preferably detects distances to multiple second positions provided along the cross direction crossing the movement direction of the mobile body and corresponding to the multiple first positions.
According to such a configuration, the information processing apparatus can detect the distance change due to the shape of the predetermined surface in the environment within a predetermined area.
In the present invention, the information processing apparatus preferably further includes a posture detection section configured to detect the posture of the mobile body. The first distance sensor and the second distance sensor preferably include a direction changing unit configured to change a distance detection direction. The control section preferably causes the direction changing unit to change the distance detection directions of the first distance sensor and the second distance sensor such that a distance to the predetermined surface is detectable in a case where the posture detection section has detected the change in the posture of the mobile body.
According to such a configuration, the information processing apparatus can reliably detect the distance to the predetermined surface in the environment even in a case where the posture of the mobile body has changed.
In the present invention, the second distance sensor preferably has a lower resolution than that of the first distance sensor.
According to such a configuration, the second distance sensor detects the distance to the second position at the position closer to the mobile body than the first position is to along the movement direction of the mobile body, and has a lower resolution than that of the first distance sensor. Thus, balance between the change in the distance detected by the first distance sensor and the change in the distance detected by the second distance sensor can be achieved. According to this configuration, the distance change distinguishing unit can easily distinguish the distance change due to the change in the posture of the mobile body and the distance change due to the shape of the predetermined surface in the environment from each other.
In the present invention, the information processing apparatus preferably further includes the posture detection section configured to detect the posture of the mobile body. The control section preferably includes a reliability evaluation unit configured to evaluate, based on the change in the posture of the mobile body detected by the posture detection section, the reliabilities of the changes, which are acquired by the distance change acquisition unit, in the distances to the first position and the second position. The distance change comparison unit preferably determines, based on an evaluation result of the reliability evaluation unit, whether or not the changes, which are acquired by the distance change acquisition unit, in the distances to the first position and the second position are to be compared.
According to such a configuration, the distance change comparison unit determines, based on the evaluation result of the reliability evaluation unit, whether or not the changes, which are acquired by the distance change acquisition unit, in the distances to the first position and the second position are to be compared, and therefore, comparison between the less-reliable changes in the distances to the first position and the second position can be avoided and a calculation cost can be reduced.
The mobile robot of the present invention includes any one of the above-described information processing apparatus and a mobile section configured to move the mobile body.
According to such an aspect of the present invention, the mobile robot can reliably detect the distance change (e.g., asperities or an obstacle) due to the shape of the predetermined surface in the environment. Thus, influence of the change in the posture of the mobile robot (the mobile body) on distance measurement can be reduced, and the accuracy of measurement of the distance to the target object on the predetermined surface, such as asperities or an obstacle, can be improved. The mobile robot can properly determine whether or not the mobile robot avoids or moves over the obstacle upon movement.
Hereinafter, one embodiment of the present invention will be described based on
The control section 2 includes an arithmetic section such as a CPU and a storage section such as a ROM or a RAM to control operation of the robot body 1A. As illustrated in
The detection section 3 includes, for example, first distance sensors 31 and second distance sensors 32 as front sensors provided at a front portion of the robot body 1A, sensor direction changing units 33 configured to change the directions of distance detection by these distance sensors 31, 32, and a posture detection section 34 configured to detect the posture of the robot body 1A. The multiple first distance sensors 31 and the multiple second distance sensors 32 are provided at the front portion of the robot body 1A, and are for measuring a distance to the target object in the front of the robot body 1A. For example, the distance sensor 31, 32 may include a laser range finder configured to emit laser light such as infrared laser to measure the distance. The sensor direction changing unit 33 turns the first distance sensor 31 and the second distance sensor 32 in an upper-lower direction to change a laser light emission direction. The posture detection section 34 includes, for example, an acceleration sensor, and detects, e.g., the inclination of the robot body 1A with respect to a horizontal surface.
As illustrated in
The mobile section 4 includes drive units 41 having a motor etc., four front, back, right, and left wheels 42, and vehicle height adjustment units 43 configured to change the heights of the front wheels to adjust the vehicle height of the robot body 1A. The drive units 41 independently rotatably drive the wheels 42 as the right and left back wheels, thereby moving the robot body 1A forward or backward or changing the direction of the robot body 1A. The vehicle height adjustment units 43 displace the wheels 42 as the right and left front wheels in the upper-lower direction, thereby adjusting the vehicle height of the robot body 1A.
Next, in a case where an object M is present on the floor surface F in the front of the mobile robot 1 in the movement direction D1 as illustrated in
When the first change value S1 and the second change value S2 are obtained as described above, the distance change comparison unit 24 of the control section 2 compares the first change value S1 and the second change value S2. For example, as a comparison method by the distance change comparison unit 24, a differential value S3 as a difference between the first change value S1 and the second change value S2 is calculated, and a time difference T1 between a first differential value S3a and a second differential value S3b remaining in the differential value S3 is calculated, as illustrated in
On the other hand, examples of the distance change due to the change in the posture of the mobile robot 1 may include a case illustrated in
The posture detection section 34 of the detection section 3 detects the change in the posture of the mobile robot 1. That is, when the robot body 1A vibrates or swings to tilt back and forth and right and left on the floor surface F due to, e.g., fine asperities of the floor surface F, seams of floorings or tiles, or carpet gaps, the posture change such as vibration, tilting, or swing is detected by the posture detection section 34 and is transmitted to the detection control unit 22. When the change in the posture of the robot body 1A is detected as described above, the reliability evaluation unit 26 of the control section 2 evaluates the reliabilities of the first change value S1 and the second change value S2 acquired by the distance change acquisition unit 23. Further, the distance change comparison unit 24 determines, based on evaluation results of the reliability evaluation unit 26, whether or not the first change value S1 and the second change value S2 are to be compared. That is, in a case where the reliability evaluation unit 26 evaluates that the change values S1, S2 are not reliable, comparison between the first change value S1 and the second change value S2 by the distance change comparison unit 24 as described above is not executed.
The steps of processing the movement information on the mobile robot 1 by the information processing apparatus 5 (the control section 2 and the detection section 3) as described above will be also described with reference to
When the control section 2 starts the movement information processing while the mobile robot 1 is moving, the detection control unit 22 causes the first distance sensor 31 to detect the distance to the first position P1 (a first distance detection step: the step ST1), and causes the second distance sensor 32 to detect the distance to the second position P2 (a second distance detection step: the step ST2). Moreover, the detection control unit 22 causes the posture detection section 34 to detect the change in the posture of the robot body 1A (a posture change detection step: the step ST3). After the distances to the first position P1 and the second position P2 have been detected at the distance detection steps (the steps ST1, ST2), the distance change acquisition unit 23 acquires the change in the distance to the floor surface F, and causes the storage unit 27 to store the change values S1, S2 (a distance change acquisition step: the step ST4). After the change in the posture of the robot body 1A has been detected at the posture change detection step (the step ST3), the reliability evaluation unit 26 evaluates the reliabilities of the change values S1, S2 (a reliability evaluation step: the step ST5).
In a case where it is, at the reliability evaluation step (the step ST5), determined that the change values S1, S2 are not reliable (NO at the step ST6), the control section 2 returns the processing to the first distance detection step (the step ST1) to repeat each of the above-described steps ST1 to ST5. In a case where it is, at the reliability evaluation step (the step ST5), determined that the change values S1, S2 are reliable (YES at the step ST5), the control section 2 executes the subsequent step ST7. That is, the distance change comparison unit 24 calculates the differential value S3 as the difference between the first change value S1 and the second change value S2 (a distance change comparison step: the step ST7). Next, the distance change distinguishing unit 25 distinguishes, based on the differential value S3, the distance change due to the change in the posture of the mobile robot 1 and the distance change due to the shape of the floor surface F (a distance change distinguishing step: the step ST8), and thereafter, the processing returns to the first distance detection step (the step ST1).
The movement information on the mobile robot 1 is processed as described above, and in this manner, the control section 2 constantly determines whether or not the floor surface F in the front of the robot body 1A in the movement direction D1 is flat and the robot body 1A can run on the floor surface F or whether or not, e.g., asperities or an obstacle (the object M) are present on the floor surface F in the front of the robot body 1A in the movement direction D1 while the robot body 1A is running by means of the mobile section 4. In a case where the obstacle (the object M) is present on the floor surface F in the front of the robot body 1A in the movement direction D1, the height of the object M from the floor surface F is also determined, and therefore, the control section 2 determines whether or not the robot body 1A can move over the object M. In a case where it is determined that the robot body 1A cannot move over the object M, the control section 2 drivably controls the mobile section 4 by the movement control unit 21 to avoid the object M. In a case where it is determined that the robot body 1A can move over the object M without the need for adjusting the vehicle height of the robot body 1A, the control section 2 continues drive control of the mobile section 4 by the movement control unit 21 such that the robot body 1A moves over the object M.
On the other hand, in a case where it is determined that the robot body 1A can move over the object M if the vehicle height of the robot body 1A is adjusted, the control section 2 drivably controls the vehicle height adjustment units 43 by the movement control unit 21 to downwardly displace the wheels 42 as the right and left front wheels as illustrated in
According to the present embodiment as described above, the following features/advantageous effects can be provided.
(1) The control section 2 of the mobile robot distinguishes, by the distance change distinguishing unit 25, the distance change (the change with the same phase) due to the change in the posture of the robot body 1A and the distance change (the change with the phase difference) due to the shape of the floor surface F in the environment from each other, and excludes the distance change due to the change in the posture of the robot body 1A while employing the distance change due to the shape of the floor surface F. Thus, the target object such as asperities or an obstacle can be accurately detected. Thus, influence of the change in the posture of the robot body 1A on distance measurement can be reduced, and the accuracy of measurement of the distance to the target object on the floor surface F, such as asperities or an obstacle, can be improved.
(2) The first distance sensors 31 and the second distance sensors 32 detect the distances to the multiple first positions P1 and the multiple second positions P2 along the cross direction D2 crossing the movement direction D1 of the robot body 1A, and therefore, the distance change due to the shape of the floor surface F can be detected within an area corresponding to the robot body 1A.
(3) The second distance sensor 32 has a lower resolution than that of the first distance sensor 31, and therefore, when the distance to the second position P2 at the position closer to the robot body 1A than the first position P1 is to is detected along the movement direction D1, balance with the change in the distance, which is detected by the first distance sensor 31, to the first position P1 can be achieved. Thus, the distance change distinguishing unit 25 can easily distinguish the distance change due to the change in the posture of the robot body 1A and the distance change due to the shape of the floor surface F from each other.
(4) The distance change comparison unit 24 determines, based on the evaluation results of the reliability evaluation unit 26, whether or not the changes, which are acquired by the distance change acquisition unit 23, in the distances to the first position P1 and the second position P2 are to be compared, and therefore, comparison between the less-reliable changes in the distances to the first position P1 and the second position P2 can be avoided and a calculation cost can be reduced.
(5) The control section 2 changes the directions of the first distance sensors 31 and the second distance sensors 32 by the sensor direction changing units 33 based on the change in the posture of the robot body 1A detected by the posture detection section 34 so that a distance to the floor surface F in a predetermined direction can be detected. Thus, even in a case where the posture of the robot body 1A has changed, the distance to the floor surface F in the environment can be reliably detected.
Note that the present invention is not limited to the above-described embodiment, and variations, modifications, etc. made within such a scope that the object of the present invention can be achieved are included in the present invention.
For example, in the above-described embodiment, specific examples have not been described as the mobile robot 1. Examples of the mobile robot include a service robot and a home robot. More specifically, the examples may include a cleaning robot, a security robot, a transfer robot, and a guidance robot. Further, a movement area of the mobile body is not limited to a two-dimensional planar space, and may be a three-dimensional space. In this case, the mobile body may be a flying body such as a drone. Moreover, the predetermined surface in the environment is not limited to the horizontal surface such as the floor surface F, and may be a flat surface such as a vertical surface or an inclined surface or may be an optional curved surface.
In the above-described embodiment, the control section 2 and the detection section 3 forming the information processing apparatus 5 are provided at the robot body 1A as the mobile body. However, the entirety or part of the control section 2 is not necessarily provided at the robot body 1A, but may be provided at other types of equipment communicable with the robot body 1A and the other types of equipment may implement all or some functions of the control section 2. The information processing apparatus of the present invention is not limited to application to the mobile robot 1, and can be also utilized for the purpose of processing movement information on a mobile body such as a self-driving automobile, a service vehicle, or a flying body. The mobile body is not limited to one including the mobile section 4 as in the mobile robot 1, and may be, e.g., a carriage moved by other apparatuses, persons, etc.
In the above-described embodiment, it is configured such that the distance change comparison unit 24 determines, based on the evaluation results of the reliability evaluation unit 26, whether or not the changes, which are acquired by the distance change acquisition unit 23, in the distances to the first position P1 and the second position P2 are to be compared and no comparison between the distance changes is made in the case of a low reliability. However, it may be configured such that all distance changes are compared regardless of the reliability. In the above-described embodiment, the posture detection section 34 detects the change in the posture of the robot body 1A, and the sensor direction changing units 33 change the directions of the first distance sensors 31 and the second distance sensors 32. However, the posture detection section 34 and the sensor direction changing unit 33 are not essential configurations for the present invention, and can be omitted as necessary.
In the above-described embodiment, the first distance sensor 31 and the second distance sensor 32 are configured as the laser range finders configured to emit the laser light to measure the distances, but the distance sensor is not limited to the laser range finder. The distance sensor may be an optical sensor such as an infrared sensor or light detection and ranging or laser imaging detection and ranging (LIDAR) or an ultrasonic sensor. Alternatively, the distance sensor may be an image sensor having a camera and an imaging element. In the above-described embodiment, the acceleration sensor has been described as an example of the posture detection section 34, but the posture detection section 34 is not limited to above and may be a gyroscope sensor. In the above-described embodiment, the posture detection section 34 is configured to detect both of a fine change in the posture of the robot body 1A, such as vibration, tilting, or swing, and a great change in the posture of the robot body 1A due to the change in the vehicle height by the vehicle height adjustment units 43 or movement of the robot body 1A over the object M. However, separate sensors may form a first posture detection section configured to detect the fine posture change and a second posture detection section configured to detect the great posture change.
In the above-described embodiment, the multiple first distance sensors 31 and the multiple second distance sensors 32 are provided at the front portion of the robot body 1A, but the present invention is not limited to above. A configuration illustrated in
In the above-described embodiment, the first distance sensor 31 and the second distance sensor 32 are configured as separate sensors, but the present invention is not limited to above. A configuration illustrated in
As described above, the present invention can be suitably utilized for an information processing apparatus and a mobile robot so that influence of a change in the posture of a mobile body can be reduced and the accuracy of measurement of a distance to a target object can be improved.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2018/035294 | 9/25/2018 | WO | 00 |