CN104898658A - Autonomous moving robot and control method thereof - Google Patents

Autonomous moving robot and control method thereof Download PDF

Info

Publication number
CN104898658A
CN104898658A CN201510097052.XA CN201510097052A CN104898658A CN 104898658 A CN104898658 A CN 104898658A CN 201510097052 A CN201510097052 A CN 201510097052A CN 104898658 A CN104898658 A CN 104898658A
Authority
CN
China
Prior art keywords
range sensor
self
information
estimation
mobile robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201510097052.XA
Other languages
Chinese (zh)
Other versions
CN104898658B (en
Inventor
高冈丰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Publication of CN104898658A publication Critical patent/CN104898658A/en
Application granted granted Critical
Publication of CN104898658B publication Critical patent/CN104898658B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0272Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses an autonomous moving robot and its control method. The autonomous moving robot includes: a distance sensor; an estimation unit configured to estimate a self position based on a distance measured by the distance sensor and map information; a normal line calculating unit configured to calculate a plane based on the distance and calculate the normal line of the plane; and a determination unit configured to calculate a histogram representing a distribution of normal line angles indicating a direction of the normal line and determines whether information of the distance sensor is insufficient based on the calculated histogram. The autonomous moving robot autonomously moves based on the self position estimated. At least one of a control process of changing a measurement direction of the distance sensor, a process of changing an estimation method of the self position, or a control process of taking a predetermined safety action is performed when the determination unit determines that the information is insufficient.

Description

Autonomous mobile robot and control method thereof
Technical field
The present invention relates to autonomous mobile robot and control method thereof, this autonomous mobile robot is estimated self-position and is independently moved based on the self-position estimated.
Background technology
Known a kind of autonomous object, it is based on the distance estimations self-position measured by range sensor (No. 2005-157689th, Japanese Unexamined Patent Application Publication (JP 2005-157689 A)).
Such as, when moving in the environment of autonomous object 10 wall that graphic appearance is perpendicular to one another in such as Fig. 2, the relative position on fore-and-aft direction and left and right directions is determined.Correspondingly, autonomous object 10 can estimate self-position with pin-point accuracy.
On the other hand, when autonomous object 10 in such as Fig. 3 graphic only occur in one direction moving in the environment of wall time, determine relative position in the lateral direction, but do not determine relative position in the longitudinal direction.By this way, when the range information of range sensor be in one direction biased and thus not enough time, there is self-position evaluated error will become larger possibility.
Summary of the invention
The invention provides a kind of autonomous mobile robot and control method thereof, this autonomous mobile robot can improve the accuracy of estimation of self-position and improve security.
According to an aspect of the present invention, a kind of autonomous mobile robot is provided.Autonomous mobile robot comprises: range sensor, and it measures the distance of object; Estimation unit, is configured to based on the distance measured by range sensor and indicates the cartographic information of the mobile environment of autonomous mobile robot to estimate self-position; Normal computing unit, is configured to the distance Calculation Plane based on being measured by range sensor, and the normal of Calculation Plane; And determining unit, whether the information of the histogram being configured to calculate the distribution of the normal angle in the direction representing the normal that instruction is calculated by normal computing unit and the range sensor determining estimating self-position based on the histogram calculated is not enough.Based on the self-position estimated by estimation unit, autonomous mobile robot independently moves.When the information of determining unit determination range sensor is not enough, performs the control procedure of the direction of measurement changing range sensor, change the process of the method for estimation of self-position or take at least one in the control procedure of predetermined security initiative.
According to this aspect, when the information of range sensor is not enough, the quantity of information of range sensor is increased by the control procedure performing the direction of measurement changing range sensor, and suppressed the impact of the error of range sensor by the method for estimation changing self-position, thus the accuracy of estimation of self-position can be improved.Also security can be improved by performing the control procedure taking predetermined security initiative.
Can improve self-position accuracy of estimation and can improve security in, when do not occur in the histogram calculated the normal angle with orthogonality relation frequency peak, do not occur equably in the histogram calculated normal angle multiple frequency peak and in the histogram calculated, normal angle does not distribute equably time, the information that determining unit can determine the range sensor estimating self-position is not enough.
According to this aspect, easily tentatively can determine that the quantity of information of range sensor is not enough, tentatively can determine to take some countermeasures based on this thus, such as change the control procedure of the direction of measurement of range sensor, change the process of the method for estimation of self-position and take the control procedure of predetermined security initiative.
In this regard, when the information of determining unit determination range sensor is not enough, estimation unit can calculate based on the distance measured by range sensor the multiple estimated position candidates being estimated as self-position, can be self-position by the location estimation extracted from calculated estimated position candidate, and the number perpendicular to the estimated position candidate on the direction of peak normal angle in histogram can be increased in.
According to this aspect, can improve at relative position not by the accuracy of estimation of the self-position in the vertical direction determined.
In this regard, when the state of the information deficiency of determining unit determination range sensor is maintained predetermined time amount or more time quantum, the control procedure of the direction of measurement changing range sensor can be performed, change the process of the method for estimation of self-position or take at least one in the control procedure of predetermined security initiative.
According to this aspect, the state can promptly tackled due to the information deficiency of range sensor is maintained the evaluated error of predetermined time amount or more time quantum and exaggerated self-position.
In this regard, autonomous mobile robot may further include control module, it is configured to the control procedure performing the direction of measurement changing range sensor, to produce in histogram, there is the frequency peak of the normal angle of orthogonality relation, and perform and take to slow down and the control procedure of predetermined security initiative stopping autonomous mobile robot or give a warning.
The process of the control procedure being changed the direction of measurement of range sensor by execution and the method for estimation changing self-position, with the deficiency of the information of complementary range sensor, can improve the accuracy of estimation of self-position.By self-position loss front reduction gear and stop autonomous mobile robot or give a warning, the loss of self-position can be suppressed.
In this regard, autonomous mobile robot may further include: wheel, and it allows autonomous mobile robot to move; Rotation detecting circuit, it detects the rotation information of wheel; And image acquisition unit, it obtains the image information around autonomous mobile robot.Estimation unit can estimate self-position based on the first method of estimation and the second method of estimation, and when the information of determining unit determination range sensor is not enough, the weight of the second method of estimation can be set to higher than the weight of the first method of estimation by estimation unit, wherein, first method of estimation is based on the Distance geometry cartographic information measured by range sensor, odometry method is used to estimate self-position, second method of estimation is based at least one in the rotation information detected by rotation detecting circuit or the image information obtained by image acquisition unit, odometry method is used to estimate self-position.The weight of the second method of estimation is set to higher than the weight of the first method of estimation, to reduce the impact using and comprise the self-position of the first method of estimation of the error of range sensor, and increase the impact using and do not comprise the self-position of the second method of estimation of the error of range sensor.
According to this aspect, the impact of the error owing to range sensor can be reduced, and self-position can be estimated with pin-point accuracy.
According to a further aspect in the invention, provide a kind of control method of autonomous mobile robot, this autonomous mobile robot comprises range sensor and estimation unit, range sensor measures the distance of object, estimation unit is configured to estimate self-position based on the cartographic information of the mobile environment of the Distance geometry instruction autonomous mobile robot measured by range sensor, and independently moves based on the self-position estimated by estimation unit.The control method of autonomous mobile robot comprises: based on the distance Calculation Plane measured by range sensor, and the normal of Calculation Plane; Calculate the histogram of the distribution of the normal angle in the direction representing the normal that index gauge is calculated, and whether the information determining the range sensor estimating self-position based on the histogram calculated is not enough; And when determining that the information of range sensor is not enough, performing the control procedure of the direction of measurement changing range sensor, changing the process of the method for estimation of self-position or taking at least one in the control procedure of predetermined security initiative.
According to each aspect of the present invention, the accuracy of estimation that can improve self-position and the autonomous mobile robot improving security and its control method can be provided.
Accompanying drawing explanation
With reference to accompanying drawing, below by the feature of description illustrative embodiments of the present invention, advantage and technology and industrial significance, Reference numeral similar in the accompanying drawings refers to similar element, wherein:
Fig. 1 is the block diagram of the system configuration of schematically diagram autonomous mobile robot according to the embodiment of the present invention;
Fig. 2 is that diagram estimates the figure of the situation of self-position based on the range information obtained by measuring vertical wall;
Fig. 3 is that diagram estimates the figure of the situation of self-position based on the range information obtained by only measuring wall on a direction of such as passage;
Fig. 4 is the block diagram of the system configuration of schematically diagram control module according to the embodiment of the present invention;
Fig. 5 is the figure in the direction of the normal of graphic computation;
Fig. 6 is the figure that diagram has the peak normal angle of orthogonality relation;
Fig. 7 is the figure that the situation of multiple peaks normal angle appears in diagram equably;
Fig. 8 is the figure of the situation that diagram normal angle distributes equably;
Fig. 9 is the figure that the situation of a peak normal angle only appears in diagram;
Figure 10 is the process flow diagram of the control procedure stream of the control method of diagram autonomous mobile robot according to the embodiment of the present invention; And
Figure 11 is that diagram execution makes the direction of measurement of range sensor in the face of the figure perpendicular to the situation of the control on the surface of wall surface.
Embodiment
Hereinafter, with reference to accompanying drawing, embodiments of the present invention will be described.Autonomous mobile robot according to the embodiment of the present invention estimates self-position with pin-point accuracy, and independently moves based on the self-position estimated.Fig. 1 is the block diagram of the system configuration of schematically diagram autonomous mobile robot according to the present embodiment.Autonomous mobile robot 1 according to the present embodiment comprises the control module 5 of the range sensor 2 of the distance measuring object, the rotation sensor 3 detecting the rotation information of wheel, the motor 4 driving wheel rotatably and control motor 4.
Range sensor 2 measures the distance (multiple measurement point) of the object of barrier, wall surface and road surface in the mobile environment of such as autonomous mobile robot 1 movement.Range sensor 2 is such as laser sensor or sonac, and is attached to autonomous mobile robot health, with on the direct of travel of autonomous mobile robot 1 towards road surface.Range sensor 2 is such as two-dimensional distance sensor, and it gives off laser beam to scan mobile environment by fluctuation in the horizontal direction.Range sensor 2 exports the range information of measurement to control module 5.
Rotation sensor 3 detects the rotation information (such as rotation angle, angular velocity of rotation and rotating angular acceleration) of wheel and exports the rotation information of detection to control module 5, and wherein wheel allows autonomous mobile robot 1 to move.Motor 4 drives wheel rotatably according to the control signal from control module 5.
Control module 5 controls motor 4 based on the range information exported from range sensor 2 and from the rotation information that rotation sensor 3 exports, and independently moves to allow autonomous mobile robot 1.
At hardware aspect, control module 5 is made up of microcomputer, and microcomputer comprises: CPU (central processing unit) (CPU) 5a performing control procedure, arithmetical operation etc.; Comprise the ROM (read-only memory) (ROM) of control program, arithmetic routine etc. or the storer 5b of random access memory (RAM) that store and performed by CPU 5a; For interface unit (I/F) 5c about outside input and output signal.CPU 5a, storer 5b and interface unit 5c are connected to each other via data bus 5d etc.
When estimating self-position based on the range information measured by range sensor with pin-point accuracy, be necessary to estimate self-position based on enough range informations.Such as, as graphic in fig. 2, when autonomous object 10 estimates self-position based on the range information obtained by measuring wall perpendicular to one another, the relative position on fore-and-aft direction and left and right directions is determined.By this way, when the range information of range sensor is enough, self-position can be estimated with pin-point accuracy.On the other hand, as graphic in figure 3, when autonomous object 10 estimates self-position based on the range information obtained by only measuring wall on a direction of such as passage, relative position is in the lateral direction determined, but relative position in the longitudinal direction is not determined.By this way, when the range information of range sensor is biased in one direction and is not enough, the evaluated error of self-position increases, and such as there is the possibility that self-position will lose.
On the contrary, when determining that the information of range sensor 2 is not enough, autonomous mobile robot 1 according to the present embodiment performs the control procedure of the direction of measurement changing range sensor 2, the process changing the method for estimation of self-position and takes in the control procedure of predetermined security initiative at least one.
Correspondingly, when the information of range sensor 2 is not enough, the quantity of information of range sensor 2 is increased by the control procedure performing the direction of measurement changing range sensor 2, and suppressed the impact of the error of range sensor 2 by the method for estimation changing self-position, thus the accuracy of estimation of self-position can be improved.The control procedure of predetermined security initiative can also be taked to improve security by performing.
In other words, in order to estimate self-position according to the measurement data of range sensor 2 with pin-point accuracy, tentatively can determine that whether the information of range sensor 2 is not enough.When determining that the information of range sensor 2 is not enough, the process of the control procedure of the direction of measurement of range sensor 2 or the method for estimation of change self-position can be changed with undercompensation by execution, improving the accuracy of estimation of self-position.Before losing at self-position, perform the control procedure taking predetermined security initiative, the loss of self-position can be suppressed.
Fig. 4 is the block diagram of the system configuration of schematically diagram control module according to the present embodiment.Control module 5 according to the present embodiment comprises quantity of information determiner 51, self-position estimator 52 and controller 53, whether the quantity of information that quantity of information determiner 51 determines the range sensor 2 estimating self-position is not enough, self-position estimated by self-position estimator 52, and controller 53 controls motor 4 based on the self-position estimated.
Quantity of information determiner 51 is concrete examples of normal computing unit and determining unit, and for carrying out the normal (Fig. 5) of Calculation Plane and Calculation Plane based on the distance measured by range sensor 2.Quantity of information determiner 51 calculates the normal of the plane that the plane that comprises multiple (such as, three) contiguous measurement point and calculating calculate based on the distance measured by range sensor 2.Quantity of information determiner 51 calculates the normal by the measurement point of range sensor 2 measuring distance, and reckoner illustrates the histogram of the normalized number (frequency) in present normal direction (normal angle).Quantity of information determiner 51 extracts the normal angle (peak normal angle) that frequency is peak from the histogram calculated.Quantity of information determiner 51 determines whether (1) occurs having the peak normal angle of orthogonality relation in the histogram calculated, and whether (2) occur multiple peaks normal angle equably, or whether (3) normal angle distributes equably.
(1)
As graphic in figure 6, in the mobile environment occurring vertical wall, the difference between the adjacent peak normal angle in histogram is 90 °, and peak normal angle has orthogonality relation.In this case, because determine relative position relation on fore-and-aft direction and left and right directions, so the accuracy of estimation of self-position is high.
(2)
As graphic in the figure 7, occurring with substantially equal angle, in the mobile environment of multiple wall (but not occurring orthogonal wall), in histogram, occurring multiple peaks normal angle equably.In this case, because determine relative position relation in a plurality of directions, so the accuracy of estimation of self-position is high.
(3)
As graphic in fig. 8, in the mobile environment occurring many free form surfaces, do not occur peak normal angle, but go out the normal of ready-made all normal angle equably, normal angle distributes equably.In this case, because determine relative position relation in a plurality of directions, so the accuracy of estimation of self-position is high.When histogram is under (1) state to (3), quantity of information determiner 51 determines the information enough (not being not enough) of the range sensor 2 estimating self-position.
When determine histogram meet (1) to (3) state and enough for the information of the range sensor 2 estimating self-position time, quantity of information determiner 51 exports the first signal of this fact of instruction to self-position estimator 52.
On the other hand, such as, when in the histogram calculated, the peak normal angle with orthogonality relation is there is not in histogram, multiple peaks normal angle is there is not equably in histogram, or when in histogram, normal angle does not distribute equably (histogram is not under (1) state to (3)), the information that quantity of information determiner 51 determines the range sensor 2 estimating self-position is not enough.
As graphic in fig .9, in the mobile environment of the wall in appearance only a direction, in histogram, only there is a peak normal angle.In this case, relative position is determined in the direction of peak normal angle, but does not determine relative position in other directions.Correspondingly, the evaluated error of self-position increases.When determining that histogram is not under (l) state to (3), quantity of information determiner 51 determines that the information of range sensor 2 is not enough.When histogram is not under (1) state to (3) and when determining that the information of range sensor 2 is not enough, quantity of information determiner 51 exports the secondary signal of this fact of instruction to controller 53.
By this way, such as, even if when range sensor 2 has narrow visual field, by determining histogram whether under (1) state to (3), the character shape required for relative position whether occurring estimating autonomous mobile robot 1 in mobile environment also easily can be determined.
Self-position estimator 52 is concrete examples of estimation unit, and based on the range information exported from range sensor 2 and the cartographic information of mobile environment representing autonomous mobile robot 1, use odometry method to estimate the self-position of autonomous mobile robot 1.Such as, based on the rotation information of wheel representing the cartographic information of predetermined two-dimensional environment, the range information measured by range sensor 2 and measured by rotation sensor 3, self-position estimator 52 estimates self-position by performing matching treatment etc.Such as, prior storing map information in storer 5b.Based on the information that the sensor by autonomous mobile robot 1 detects, self-position estimator 52 can estimate self-position when not using odometry method.
When enough based on the information of the first signal determination range sensor 2 exported from quantity of information determiner 51, self-position estimator 52 performs common self-position based on the range information of range sensor 2 and estimates process.In this case, because comprise the information for determining relative position relation exactly, so self-position estimator 52 can estimate self-position based on the range information of range sensor 2 with pin-point accuracy from the range information of range sensor 2 output.
On the other hand, such as, when not enough based on the information of the secondary signal determination range sensor 2 exported from quantity of information determiner 51, self-position estimator 52 changes the method for estimation of self-position.
Here, based on the range information measured by range sensor 2 and the rotation information of wheel measured by rotation sensor 3, use odometry method, self-position estimator 52 calculates the multiple candidates (hereinafter, estimated position candidate) being estimated as the position of self-position.The location estimation extracted final from the multiple estimated position candidates calculated is self-position by self-position estimator 52.
Self-position estimator 52 calculates multiple estimated position candidate by adjustment estimated parameter.Estimated parameter is error parameter, error (difference on direct of travel, horizontal direction and angle direction) to estimated position during the position of its instruction after estimating to move preset distance.
In fig .9 in graphic example, relative position is determined in the direction (such as, horizontal direction) that histogrammic frequency is high, but do not determine relative position on perpendicular direction (such as, direct of travel).Therefore, self-position estimator 52 adjusts the estimated parameter of self-position, above not increased the number of estimated position candidate by the direction (direct of travel) determined in position.
In this case, by increasing the error parameter on direct of travel, self-position estimator 52 is increased in the number of the estimated position candidate on direct of travel.Particularly, self-position estimator 52 be increased in histogrammic peak normal angle (90 °) ± direction (vertical direction) of 90 ° on the number of estimated position candidate.By this way, by being increased in relative position not by the number of the estimated position candidate on the direction determined, can improve at relative position not by the accuracy of estimation of the self-position on the direction determined.
Although self-position estimator 52 adjusts estimated parameter, autonomous mobile robot 1 moves, and mobile environment is also changed.Correspondingly, such as, when mobile environment changes over graphic mobile environment in Fig. 6 to 8, self-position estimator 52 can use the estimated parameter that adjusts best with more pin-point accuracy to estimate self-position.
When histogram is not under (1) state to (3) and when determining that the state of information deficiency of range sensor is maintained predetermined time amount or more time quantum, quantity of information determiner 51 exports the 3rd signal of this fact of instruction to controller 53.Based on the 3rd signal exported from quantity of information determiner 51, controller 53 performs that (A) changes the control procedure of the direction of measurement of range sensor 2, (B) changes at least one that the process of the method for estimation of self-position and (C) take in the control procedure of predetermined security initiative.
(A)
Controller 53 performs the control procedure changing range sensor 2 direction of measurement based on the 3rd signal exported from quantity of information determiner 51.When the state of the information deficiency of the range sensor 2 for estimating self-position is maintained predetermined time amount or more time quantum, the evaluated error of self-position increases, thus improvement is necessary fast.Correspondingly, controller 53 on one's own initiative (actively) change the direction of measurement of range sensor 2 and the enough such as graphic environment in Fig. 6 to 8 of the information of detection range sensor 2.Controller 53 such as changes the direction of measurement of range sensor 2 in the following manner: control motor 4, to perform the control procedure of rotation (rotation) autonomous mobile robot 1, or execution has the head of range sensor 2 or the control procedure of health about yaw axis rotary setting.
Controller 53 can by driving actuator etc. with the direction of measurement driving range sensor 2 directly to change range sensor 2 rotatably.Controller 53 performs the control procedure of the direction of measurement changing range sensor 2, such as, until histogram enters (1) state to (3).Correspondingly, the information of range sensor 2 becomes enough, thus self-position estimator 52 can estimate self-position with pin-point accuracy.
(B)
Self-position estimator 52 performs the process of the method for estimation changing self-position based on the 3rd signal exported from quantity of information determiner 51.Such as, use and estimate the first method of estimation of self-position based on the distance measured by range sensor 2 and estimate the second method of estimation of self-position based on the rotation information detected by rotation sensor 3, self-position estimated by self-position estimator 52.
More specifically, by using the first method of estimation, self-position estimator 52, based on the range information measured by range sensor 2 and cartographic information, uses odometry method to estimate self-position.By using the second method of estimation, self-position estimator 52, based on the rotation information of the wheel measured by rotation sensor 3, uses odometry method to estimate self-position.Self-position estimator 52 is multiplied by predetermined weight (coefficient) by the self-position use first method of estimation estimated and the self-position that uses the second method of estimation to estimate, estimates final self-position.
When the information of range sensor 2 is not enough, uses and estimate that the self-position that the first method of estimation of self-position is estimated comprises large error based on the range information measured by range sensor 2.On the other hand, the self-position using the rotation information based on the wheel measured by rotation sensor 3 to estimate that the second method of estimation of self-position is estimated is not subject to the error effect of range sensor 2, and has more pin-point accuracy.
Therefore, self-position estimator 52 is set to the weight of the second method of estimation higher than the weight of the first method of estimation, to reduce impact based on the self-position of the first method of estimation and to increase the impact based on the self-position of the second method of estimation.Correspondingly, self-position estimator 52 can reduce the impact of the error of range sensor 2, and can estimate self-position with pin-point accuracy.
When the information of range sensor 2 is not enough, self-position estimator 52 can stop using the first method of estimation to estimate self-position, and can perform use second method of estimation estimation self-position.Such as, as the second method of estimation, based on the image information that video camera is caught, self-position estimator 52 can use odometry method to estimate self-position.The self-position estimated based on the image information of video camera by the error effect of range sensor 2, and has more pin-point accuracy.The image that self-position estimator 52 can be caught based on video camera and the rotation information that rotation sensor 3 is measured, use odometry method to estimate self-position.
(C)
Controller 53 performs based on the 3rd signal exported from quantity of information determiner 51 control procedure taking predetermined security initiative.When the state of the information deficiency of the range sensor 2 for estimating self-position is maintained predetermined time amount or more time quantum, the evaluated error of self-position is large and there is the possibility that self-position will lose.Therefore, controller 53 can perform the control procedure taking predetermined security initiative.
Such as, controller 53 stops self-position estimator 52 to estimate self-position, and controls motor 4 and slow down to perform and stop the control procedure of autonomous mobile robot 1.Controller 53 can use warning unit 6 couples of users to provide warning.The example of warning unit 6 comprises output and warns the lighting device of the voice output of sound, opening/closing emergency warning lamp, shows the display device of warning, produces the vibrating device of warning and vibrating and the communicator user of remote location being provided to warning.Correspondingly, even if when the state of the information deficiency of range sensor 2 is maintained and the evaluated error of self-position increases, the security of autonomous mobile robot 1 also can be ensured.
Figure 10 is the process flow diagram of the control procedure stream of the control method of diagram autonomous mobile robot according to the present embodiment.Repeatedly, such as, every the predetermined short time, perform graphic control procedure stream in Figure 10.
Range sensor 2 measures the distance (step S101) of the object in the mobile environment of autonomous mobile robot 1 movement, and exports the distance of measurement to quantity of information determiner 51 and self-position estimator 52.
Quantity of information determiner 51 calculates the plane comprising the measurement point of multiple vicinity based on the distance measured by range sensor 2, and the normal of the plane calculated (step S102).Quantity of information determiner 51 calculates the normal measuring all measurement point of its distance at range sensor 2, and calculates the histogram (step S103) of normal angle.Quantity of information determiner 51 extracts peak normal angle (step S104) from the histogram calculated.
Quantity of information determiner 51 determines whether (1) occurs having the peak normal angle of orthogonality relation in the histogram calculated, (2) whether occur multiple peaks normal angle equably, or whether (3) normal angle distributes (step S105) equably.
When determining that the peak normal angle of orthogonality relation does not appear having in (1) in the histogram calculated, (2) there is not multiple peaks normal angle equably, and (3) normal angle is not when distributing equably ("No" in step S105), the information that quantity of information determiner 51 determines the range sensor 2 estimating self-position is not enough.In this case, self-position estimator 52 adjusts the estimated parameter for estimating self-position, be increased in peak normal angle in histogram (90 °) ± 90 ° of directions on the number (step S106) of estimated position candidate.
Quantity of information determiner 51 determines whether the state of histogram whether not under (1) state to (3) and for the information deficiency of the range sensor 2 of estimating self-position is maintained the first predetermined time amount or more time quantum (step S107).
When quantity of information determiner 51 determines that the state of the information deficiency of range sensor 2 is maintained the first predetermined time amount or more time quantum ("Yes" in step S107), controller 53 performs the control procedure (step S108) that (A) changes the direction of measurement of range sensor 2.
Now, controller 53 can not perform the control procedure that (A) changes the direction of measurement of range sensor 2, but self-position estimator 52 can perform the process that (B) changes the method for estimation of self-position.Controller 53 performs the control procedure that (A) changes the direction of measurement of range sensor 2, and self-position estimator 52 can perform the process that (B) changes the method for estimation of self-position.Quantity of information determiner 51 determines whether the state of the information deficiency of range sensor 2 is maintained the second predetermined time amount (the second predetermined time amount > first predetermined time amount) or more time quantum (step S109).
When quantity of information determiner 51 determines that the state of the information deficiency of range sensor 2 is maintained the second predetermined time amount or more time quantum ("Yes" in step S109), controller 53 performs the control procedure (step S110) that (C) takes predetermined security initiative.By this way, when the state that have passed through the information deficiency of predetermined time amount and range sensor 2 after being changed at the direction of measurement of range sensor 2 is maintained, the evaluated error of self-position is large, and there is the possibility that self-position will lose.Correspondingly, by taking predetermined security initiative, the loss of self-position is prevented satisfactorily.On the other hand, when quantity of information determiner 51 determines that the information of range sensor 2 is enough ("No" in step S109), process streams moves to following process (step S111).
When in the histogram calculated, the peak normal angle with orthogonality relation appears in (1), (2) there is multiple peaks normal angle equably, or (3) normal angle is when distributing equably ("Yes" in step S105), the information that quantity of information determiner 51 determines the range sensor 2 estimating self-position is enough.In this case, self-position estimator 52, based on the range information exported from range sensor 2 and cartographic information, use odometry method to estimate self-position (step S111), and control procedure stream terminates.
In control procedure stream, when quantity of information determiner 51 determines that the peak normal angle of orthogonality relation does not appear having in (1) in the histogram calculated, (2) there is not multiple peaks normal angle equably, and (3) normal angle is not when distributing equably ("No" in step S105), self-position estimator 52 can not adjust estimated parameter, but the control procedure that (A) changes the direction of measurement of range sensor 2 can be performed immediately, (B) at least one that the process of method of estimation of self-position and (C) take in the control procedure of predetermined security initiative is changed.
In step S105, quantity of information determiner 51 can by determining that the peak normal angle whether (1) occurs having orthogonality relation in the histogram calculated determines that whether the information of range sensor 2 is not enough.Correspondingly, deterministic process can be simplified, thus minimizing assesses the cost.As mentioned above, in autonomous mobile robot 1 according to the present embodiment, based on the distance measured by range sensor 2, quantity of information determiner 51 calculates the histogram of the distribution of the normal angle in the direction of the normal representing instruction plane.Based on the histogram calculated, whether the information that quantity of information determiner 51 determines the range sensor 2 estimating self-position is not enough.When quantity of information determiner 51 determines that the information of range sensor 2 is not enough, perform the control procedure of the direction of measurement changing range sensor 2, change the process of the method for estimation of self-position and take at least one in the control procedure of predetermined security initiative.Correspondingly, when the information of range sensor 2 is not enough, the quantity of information of range sensor 2 is increased by the control procedure performing the direction of measurement changing range sensor 2, and suppressed the impact of the error of range sensor 2 by the method for estimation changing self-position, the accuracy of estimation of self-position can be improved thus.Also the control procedure of predetermined security initiative can be taked to improve security by performing.
The invention is not restricted to above-mentioned embodiment, and can suitably be modified when not departing from its purport.Such as, in the above-described embodiment, range sensor can be the three-dimensional distance sensor obtaining three-dimensional measurement point group.
Quantity of information determiner 51 calculates the plane of such as wall surface based on the three-dimensional measurement point group measured by three-dimensional distance sensor 2, and the normal of the normal calculated.Quantity of information determiner 51 calculates the histogram of the distribution of the normal angle representing the normal calculated.Quantity of information determiner 51 extracts peak normal angle from the histogram calculated.
Quantity of information determiner 51 determines whether (1) occurs having the peak normal angle of orthogonality relation in the histogram calculated.When quantity of information determiner 51 is determined not occur the peak normal angle with orthogonality relation in the histogram calculated, controller 53 performs the control procedure that (A) changes the direction of measurement of range sensor 2.Such as, as graphic in fig. 11, controller 53 performs the control procedure of the direction of measurement directed in orthogonal of range sensor 2 in the surface (dashed area) of wall.In histogram, form the peak normal angle (Fig. 6) with orthogonality relation.Correspondingly, the information of range sensor 2 becomes enough, and self-position estimator 52 can estimate self-position with pin-point accuracy.
In the present invention, graphic process streams in Figure 10 can be implemented by making CPU 5a perform computer program.
Under the state that program is recorded in various types of non-transitory computer-readable medium, program can be provided to computing machine.Non-transitory computer-readable medium comprises various types of tangible media.The example of non-transitory computer-readable medium comprises magnetic recording media (such as floppy disk, tape and hard disk drive), Magnetooptic recording medium (such as magneto-optic disk), CD-ROM (ROM (read-only memory)), CD-R, CD-R/W and semiconductor memory (such as mask model ROM, programming ROM (PROM), erasable PROM (EPROM), flash rom, random access memory (RAM)).
Various types of transitory computer-readable medium can be used to provide program to computing machine.The example of transitory computer-readable medium comprises electric signal, light signal and electromagnetic wave.Transitory computer-readable medium can provide program via the wire communication line of such as electric wire and optical fiber or wireless communication line to computing machine.

Claims (7)

1. an autonomous mobile robot (1), is characterized in that comprising:
Range sensor (2), it measures the distance of object;
Estimation unit (52), the cartographic information be configured to based on the described distance measured by described range sensor and the mobile environment that indicates described autonomous mobile robot estimates self-position;
Normal computing unit, is configured to the described distance Calculation Plane based on being measured by described range sensor, and calculates the normal of described plane; And
Determining unit, be configured to calculate the histogram of the distribution of the normal angle in the direction representing the described normal that instruction is calculated by described normal computing unit, and whether the information determining the described range sensor estimating described self-position based on calculated histogram is not enough
Wherein based on the described self-position estimated by described estimation unit, described autonomous mobile robot independently moves, and
Wherein when described determining unit determines that the described information of described range sensor is not enough, the control procedure performing the direction of measurement changing described range sensor, the process changing the method for estimation of described self-position and take in the control procedure of predetermined security initiative at least one.
2. autonomous mobile robot according to claim 1, it is characterized in that: when the frequency peak of the described normal angle in the histogram in described calculating with orthogonality relation does not occur, not occur equably and when normal angle does not distribute equably described in the histogram of described calculating, the described information that described determining unit determines the described range sensor estimating described self-position is not enough in multiple frequency peak of normal angle described in the histogram of described calculating.
3. autonomous mobile robot according to claim 1 and 2, it is characterized in that: when described determining unit determines that the described information of described range sensor is not enough, described estimation unit is based on the described distance measured by described range sensor, calculate the multiple estimated position candidates being estimated as described self-position, be described self-position by the location estimation extracted from calculated estimated position candidate, and increase the number the estimated position candidate in the direction perpendicular to peak normal angle in described histogram.
4. the autonomous mobile robot according to any one of claims 1 to 3, it is characterized in that: when described determining unit determines that the state of the described information deficiency of described range sensor is maintained predetermined time amount or more time quantum, perform the control procedure of the direction of measurement of the described range sensor of described change, the described self-position of described change method of estimation process and described in take in the control procedure of predetermined security initiative at least one.
5. the autonomous mobile robot according to any one of Claims 1-4, is characterized in that comprising further:
Control module, be configured to the control procedure of the direction of measurement performing the described range sensor of described change, to produce in described histogram, there is the frequency peak of the described normal angle of orthogonality relation, and perform the control procedure of predetermined security initiative taked to slow down and stop described autonomous mobile robot or give a warning.
6. the autonomous mobile robot according to any one of claim 1 to 5, is characterized in that comprising further:
Wheel, it allows described autonomous mobile robot to move;
Rotation detecting circuit, it detects the rotation information of described wheel; And
Image acquisition unit, it obtains the image information around described autonomous mobile robot,
Wherein said estimation unit estimates described self-position based on the first method of estimation and the second method of estimation, and when described determining unit determines the described information deficiency of described range sensor, the weight of described second method of estimation is set to higher than the weight of described first method of estimation, wherein, described first method of estimation is based on cartographic information described in the described Distance geometry measured by described range sensor, odometry method is used to estimate described self-position, described second method of estimation is based at least one in the described rotation information detected by described rotation detecting circuit and the described image information obtained by described image acquisition unit, use described odometry method to estimate described self-position.
7. the control method of an autonomous mobile robot, described autonomous mobile robot comprises range sensor and estimation unit, described range sensor measures the distance of object, described estimation unit is configured to indicate the cartographic information of the mobile environment of described autonomous mobile robot to estimate self-position based on the described Distance geometry measured by described range sensor, and described autonomous mobile robot independently moves based on the described self-position estimated by described estimation unit, the feature of described control method is to comprise:
Based on the described distance Calculation Plane measured by described range sensor, and calculate the normal (S101, S102) of described plane;
Calculate the histogram of the distribution representing the normal angle indicating the direction of normal calculated, and determine the information whether not enough (S105) of the described range sensor estimating described self-position based on the histogram of described calculating; And
When determining that the described information of described range sensor is not enough, the control procedure performing the direction of measurement changing described range sensor, the process changing the method for estimation of described self-position and at least one (S108 taking in the control procedure of predetermined security initiative, S110, S111).
CN201510097052.XA 2014-03-06 2015-03-04 Autonomous mobile robot and its control method Expired - Fee Related CN104898658B (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2014-044330 2014-03-06
JP2014044330A JP5949814B2 (en) 2014-03-06 2014-03-06 Autonomous mobile robot and control method thereof

Publications (2)

Publication Number Publication Date
CN104898658A true CN104898658A (en) 2015-09-09
CN104898658B CN104898658B (en) 2017-11-03

Family

ID=54017294

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510097052.XA Expired - Fee Related CN104898658B (en) 2014-03-06 2015-03-04 Autonomous mobile robot and its control method

Country Status (3)

Country Link
US (1) US9207674B2 (en)
JP (1) JP5949814B2 (en)
CN (1) CN104898658B (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106092104A (en) * 2016-08-26 2016-11-09 深圳微服机器人科技有限公司 The method for relocating of a kind of Indoor Robot and device
CN107053166A (en) * 2015-12-16 2017-08-18 卡西欧计算机株式会社 Autonomous device and autonomous method
CN108225362A (en) * 2017-12-29 2018-06-29 驭势科技(北京)有限公司 Intelligent driving vehicle positioning method and system, computer storage media and positioning device
CN112631269A (en) * 2019-10-08 2021-04-09 国立大学法人静冈大学 Autonomous mobile robot and control program for autonomous mobile robot

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102310278B1 (en) * 2014-09-18 2021-10-07 현대모비스 주식회사 System and method for the vehicle autonomous emergency braking
EP3458231A1 (en) * 2016-05-20 2019-03-27 ABB Schweiz AG Improved industrial object handling robot
JP6697768B2 (en) * 2016-06-29 2020-05-27 パナソニックIpマネジメント株式会社 Walking support robot and walking support method
US10265856B2 (en) * 2016-07-21 2019-04-23 X Development Llc Reorienting a distance sensor using an adjustable leveler
US11373418B2 (en) 2017-08-04 2022-06-28 Sony Corporation Information processing apparatus, information processing method, program, and mobile object
JP6780611B2 (en) * 2017-08-25 2020-11-04 トヨタ自動車株式会社 Autonomous driving device
WO2019180765A1 (en) * 2018-03-19 2019-09-26 本田技研工業株式会社 Autonomous traveling work machine
JP7112066B2 (en) * 2018-04-04 2022-08-03 国立大学法人九州工業大学 Autonomous mobile robot and its control method
JP7211005B2 (en) * 2018-10-29 2023-01-24 富士通株式会社 Terrain estimation program, terrain estimation method, and terrain estimation device
JP7275553B2 (en) * 2018-12-10 2023-05-18 ソニーグループ株式会社 MOBILE BODY, MOBILE BODY CONTROL METHOD AND PROGRAM
JP7347226B2 (en) * 2020-01-17 2023-09-20 株式会社豊田自動織機 Self-position estimation device and self-position estimation method

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004054308A (en) * 2002-07-16 2004-02-19 Japan Science & Technology Corp Method and device for integrating distance image
CN101078632A (en) * 2006-05-26 2007-11-28 富士通株式会社 Mobile robot, and control method and program for the same
CN101233389A (en) * 2005-08-01 2008-07-30 丰田自动车株式会社 Optical gyro calibration system, robot equipped with optical gyro, and optical gyro calibration program
JP2011257244A (en) * 2010-06-08 2011-12-22 Toshiba Corp Body shape detection device and method
WO2013002067A1 (en) * 2011-06-29 2013-01-03 株式会社日立産機システム Mobile robot and self location and attitude estimation system installed upon mobile body
JP2014006835A (en) * 2012-06-27 2014-01-16 Murata Mach Ltd Autonomous traveling apparatus, autonomous traveling method, markers, and autonomous traveling system

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3994950B2 (en) * 2003-09-19 2007-10-24 ソニー株式会社 Environment recognition apparatus and method, path planning apparatus and method, and robot apparatus
JP4055701B2 (en) 2003-11-25 2008-03-05 松下電工株式会社 Autonomous mobile vehicle
US7539557B2 (en) * 2005-12-30 2009-05-26 Irobot Corporation Autonomous mobile robot
JP4962742B2 (en) * 2008-12-11 2012-06-27 株式会社安川電機 Mobile system
KR101750340B1 (en) * 2010-11-03 2017-06-26 엘지전자 주식회사 Robot cleaner and controlling method of the same
US9605952B2 (en) * 2012-03-08 2017-03-28 Quality Manufacturing Inc. Touch sensitive robotic gripper
WO2013138193A2 (en) * 2012-03-12 2013-09-19 Bar Code Specialties, Inc. (Dba Bcs Solutions) Rail-mounted robotic inventory system
EP2752726B1 (en) * 2013-01-08 2015-05-27 Cleanfix Reinigungssysteme AG Floor treatment machine and method for treating floor surfaces

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004054308A (en) * 2002-07-16 2004-02-19 Japan Science & Technology Corp Method and device for integrating distance image
CN101233389A (en) * 2005-08-01 2008-07-30 丰田自动车株式会社 Optical gyro calibration system, robot equipped with optical gyro, and optical gyro calibration program
CN101078632A (en) * 2006-05-26 2007-11-28 富士通株式会社 Mobile robot, and control method and program for the same
JP2011257244A (en) * 2010-06-08 2011-12-22 Toshiba Corp Body shape detection device and method
WO2013002067A1 (en) * 2011-06-29 2013-01-03 株式会社日立産機システム Mobile robot and self location and attitude estimation system installed upon mobile body
JP2014006835A (en) * 2012-06-27 2014-01-16 Murata Mach Ltd Autonomous traveling apparatus, autonomous traveling method, markers, and autonomous traveling system

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107053166A (en) * 2015-12-16 2017-08-18 卡西欧计算机株式会社 Autonomous device and autonomous method
CN107053166B (en) * 2015-12-16 2020-05-05 卡西欧计算机株式会社 Autonomous moving apparatus, autonomous moving method, and storage medium
CN106092104A (en) * 2016-08-26 2016-11-09 深圳微服机器人科技有限公司 The method for relocating of a kind of Indoor Robot and device
CN106092104B (en) * 2016-08-26 2019-03-15 深圳微服机器人科技有限公司 A kind of method for relocating and device of Indoor Robot
CN108225362A (en) * 2017-12-29 2018-06-29 驭势科技(北京)有限公司 Intelligent driving vehicle positioning method and system, computer storage media and positioning device
CN112631269A (en) * 2019-10-08 2021-04-09 国立大学法人静冈大学 Autonomous mobile robot and control program for autonomous mobile robot
CN112631269B (en) * 2019-10-08 2024-06-11 国立大学法人静冈大学 Autonomous mobile robot and control program for autonomous mobile robot

Also Published As

Publication number Publication date
JP5949814B2 (en) 2016-07-13
JP2015170127A (en) 2015-09-28
CN104898658B (en) 2017-11-03
US9207674B2 (en) 2015-12-08
US20150253774A1 (en) 2015-09-10

Similar Documents

Publication Publication Date Title
CN104898658A (en) Autonomous moving robot and control method thereof
US9625911B2 (en) System and method for avoiding obstacle for autonomous vehicle
CN105486311B (en) Indoor Robot positioning navigation method and device
CA2928073C (en) Automatic driving vehicle system
CN106022274B (en) Obstacle avoidance method, obstacle avoidance device and unmanned machine
KR102521655B1 (en) Autonomous driving method and apparatus
US8793069B2 (en) Object recognition system for autonomous mobile body
US9580885B2 (en) Swing operating machine and method of controlling swing operating machine
CN111830979B (en) Track optimization method and device
KR101316465B1 (en) System and method for preventing collision
CN105793731A (en) Autonomous moving object
US20140114526A1 (en) Safety apparatus for a vehicle
CN109739230B (en) Driving track generation method and device and storage medium
US9434074B2 (en) Autonomous running control method and device of autonomous running apparatus, and program for autonomous running control device
CN109941274A (en) Parking method and system, server and medium based on radar range finding identification gantry crane
CN103781685A (en) Autonomous driving control system for vehicle
JP7027054B2 (en) Information processing equipment, vehicles, information processing methods and programs
WO2015110889A1 (en) Robot and control method thereof
US10386849B2 (en) ECU, autonomous vehicle including ECU, and method of recognizing nearby vehicle for the same
KR20190025001A (en) Method and system for avoiding collisions in cranes
KR101747761B1 (en) Obstacle detecting device and moving object provided therewith
US9440651B2 (en) Method and device for monitoring a setpoint trajectory of a vehicle
JP2017015601A (en) Road surface detection device, mobile body, road surface detection method, and road surface detection program
KR20210037791A (en) Autonomous driving apparatus and method
KR20210037790A (en) Autonomous driving apparatus and method

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20171103

CF01 Termination of patent right due to non-payment of annual fee