Summary of the invention
Technical matters to be solved by this invention is the technological deficiency that overcomes in the background technology, and a kind of Adaptive Path control method with the mobile robot in the path of reliably cruising is provided.
In order to reach above purpose, the technical solution adopted in the present invention is as follows:
A kind of mobile robot's Adaptive Path control method comprises following step:
1) in mobile robot's perform region, places at least two road sign steady arms that are numbered in order;
2) mobile robot searches the distant signal that each road sign steady arm sends successively by number order, and after the distant signal that searches current road sign steady arm to its motion;
3) mobile robot serves as with reference to reference point being set, trying to achieve its virtual coordinates and it is stored into memory module as key point with time or its move distance;
4) mobile robot as key point, tries to achieve its current position its virtual coordinates and it is stored into memory module when receiving the closely signal of road sign steady arm;
5) mobile robot's virtual coordinates to key point after the search of finishing all road sign steady arms is revised;
6) mobile robot cruises by the virtual coordinates of revised key point.
In the prioritization scheme of the inventive method, described road sign steady arm comprises cradle, and the signal of described cradle is better than the signal of other road sign steady arms;
In the prioritization scheme of the inventive method, in step 3),, then return a key point, reselect a direction motion again if the mobile robot loses current road sign fixture signal.
In the further prioritization scheme of the inventive method, in step 4), the mobile robot sends an arriving signal after the short-range signal that receives the road sign steady arm, the road sign steady arm stops to send distant signal and signal closely in a period of time after receiving arriving signal.
In the further prioritization scheme of the inventive method, in step 3), the mobile robot when detecting obstacle with its current position as key point, try to achieve its virtual coordinates and it be stored into memory module;
In the further prioritization scheme of the inventive method, in step 3), the mobile robot keeps receiving the signal of road sign steady arm in the process of avoidant disorder, if lossing signal then move rearwards to key point when detecting obstacle is reselected a direction motion again;
In the further prioritization scheme of the inventive method, in step 3), the mobile robot moves on after 60 ° of the deflections when detecting obstacle to the left or to the right,, simultaneously this position is stored into memory module as key point to the right again or 60 ° of deflections left when no longer detecting obstacle.
In the further prioritization scheme of the inventive method, the correction in the described step 5) comprises virtual coordinates modification, increase key point and the deletion key point of key point.
In the further prioritization scheme of the inventive method, the distant signal of described road sign steady arm and closely signal be 360 ° of comprehensive signals.
In the further prioritization scheme of the inventive method, the signal of described road sign steady arm is infrared signal or ultrasonic signal.
The contrast prior art, the beneficial effect of the mobile robot's that the present invention discloses Adaptive Path control method is as follows:
The inventive method overcome traditional safety defense monitoring system can not move cruise and existing mobile robot is poor to the environment identification capacity, the walking no safe and reliable target defective, use that the mobile robot of this method has that the adaptive cruise environment capacity is strong, handled easily, safe and reliable advantage, in addition, this method implementation cost is lower.
Embodiment
Below in conjunction with embodiment and contrast accompanying drawing mobile robot's of the present invention Adaptive Path control method is further elaborated.
Please refer to Fig. 1 to Figure 11, be a preferred embodiment of the present invention.
Present embodiment is that example describes with the family expenses supervisory-controlled robot, use the system of method of the present invention to comprise mobile robot (Fig. 2), cradle S, road sign steady arm A-H and telepilot, as shown in Figure 1, described mobile robot comprises motion module, monitoring module, the signal transmitting and receiving module, the obstacle detection module, acquisition module, memory module and control module, described cradle S uses as the road sign steady arm when the mobile robot does not charge, the signal intensity of its transmission is greater than the signal intensity of road sign steady arm A-H, cradle S, road sign steady arm A-H presses certain frequency and continues to send 360 ° of comprehensive distant signals and 360 ° of comprehensive closely signals, the preferred infrared signal of signal or the ultrasonic signal that send adopt infrared signal in the present embodiment.
As shown in Figure 4, the chip of the road sign steady arm in the present embodiment adopts TK98P01, comprise distant signal transmitter, closely signal projector, power supply (being generally dry cell or accumulator) and first receiver, second receiver, first receiver is used to receive remote controller signal, and second receiver is used to receive mobile robot's signal.
As shown in Figure 5, the chip of the telepilot in the present embodiment adopts TK98P01, comprises signal projector, signal projector, power supply (being generally dry cell or accumulator), display screen and keyboard.
As shown in Figure 6, the main control chip of the mobile robot in the present embodiment adopts STM32F101.Driver module comprises left and right driving wheel and universal wheel; The obstacle detection module comprises that five (in preceding, left and right, the left sides, in the right side) detect inductor and five to wall and detect inductor (in preceding, left and right, the left side, in the right side) over the ground; Power module adopts the dry cell or the accumulator that can repeatedly recharge; The signal transmitting and receiving module comprise signal projector and signal receiver, wherein, the signal that signal receiver can send at 360 ° of comprehensive reception road sign steady arms; Monitoring module comprises that video capture device (camera) and audio frequency obtain equipment (MIC); Acquisition module is used for left and right sidesing driving wheel is tested the speed to obtain the moveable robot movement distance, universal wheel is tested the speed to obtain the moveable robot movement state and to use gyroscope to obtain mobile robot's direction of motion information.
As shown in Figure 6, be the process flow diagram of present embodiment.Below in conjunction with Fig. 3 and Fig. 7 this implementing procedure is elaborated.
Step 1) is placed at the place, gate of domestic environment and is recharged a S, with road sign steady arm A-H respectively in the kitchen, study, balcony, bedroom, doorway, toilet place, and places the road sign steady arm at key position (as windowsill place or valuables lay down location) then.
Step 2) respectively each road sign steady arm is provided with corresponding label by telepilot, tell the number of mobile robot's road sign steady arm and the sequencing of search road sign steady arm simultaneously, open command then, the mobile robot moves to it when keeping receiving this signal after the distant signal that searches current road sign steady arm, goes into to receive up to mobile apparatus till the closely signal of current road sign steady arm; Wherein, the mobile robot is before receiving the closely signal of road sign steady arm, if receive the signal of other road sign steady arms, the mobile robot ignores the signal that receives, and can not produce action to the received signal.
First receiver (T101) of road sign steady arm is according to receiving unlike signal that telepilot sends determining its numbering, as receives order 0XAA0X01, represents that this road sign steady arm is first the road sign steady arm that will search of mobile robot, and it is numbered A; By that analogy, when the road sign steady arm receives 0XAA0X02 ..., 0XAA0X09; Its numbering is respectively B, C, D, E, F, G, H, S; Under the default situations, S is a charging station, is generally last numbering.Mobile robot's receiver shows that the number of road sign steady arm is 9 behind the order 0Xbb0X09 that the reception telepilot sends, hear that an expression of hummer flute is provided with success.360 ° of comprehensive distant signal transmitters of road sign steady arm send order 0X01 (corresponding with road sign steady arm numbering), and the guiding mobile robot is to this road sign steady arm motion.
Step 3) mobile robot is provided with reference point after (as 5 seconds) or walking preset distance (as 20cm) at the fixed time, try to achieve its virtual coordinates and it is stored into memory module as key point, as shown in Figure 9, A1-A4 totally 4 key points are arranged between cradle S and the road sign steady arm A.
Please refer to Fig. 9, the mobile robot is after reception road sign steady arm A sends the signal of 0X01, beginning is moved to road sign steady arm A, acquisition module is to left and right sidesing driving wheel test the speed (promptly catching the photoelectric coding high level), per 200 microsecond collections are once made accumulative total L1 and L2 (not doing accumulative total if run into fault) in the walking process of left and right sidesing driving wheel; Simultaneously, acquisition module tests the speed (promptly catching the photoelectric coding high level) to angle sheave, and per 200 microsecond collections are once made accumulative total L3 (not doing accumulative total if run into fault) in walking; Gyroscope direction deflection inductor (angular velocity), per 2 milliseconds of collections once as the walk important parameter of straight line and pre-deflection angle of mobile robot, are made accumulative total ∮ 1 in walking; Mobile robot's walking mainly with straight ahead, straight line retreat, two-wheeled moves deflection left simultaneously and two-wheeled moves simultaneously four kinds of motion states of deflection to the right; In straight line moving, mobile robot's MCU calculates the speed that L1 ', a L2 ' (L1 ', L2 ' be the move distance of mobile robot in 2 milliseconds) adjust the left and right wheels of walking for per 2 milliseconds, to guarantee that the walking path track is a straight line, simultaneously gyroscope is done and is once gathered ∮ 1 ' (∮ 1 ' is the angle of mobile robot at 10 milliseconds of bias internals) for per 10 milliseconds, do the secondary correction of angular velocity, adjust ∮ 1, remedy the fluctuation in the walking, left and right sides road wheel motor runtime parameter is carried out the finishing of normal distribution; In the deflection walking, mobile robot's MCU calculates a L1 for per 2 milliseconds ", L2 ", ∮ 1 " (L1 ", L2 " be the move distance of mobile robot in 2 milliseconds; ∮ 1 " mobile robot is in the angle of 10 milliseconds of bias internals), expect with the angle of assurance deflection; When the road sign steady arm travelled, the calculating of the virtual coordinates of key point was calculated once (not having fault to take place) in per 5 seconds to the mobile robot by the normal straight walking, and (Xa Ya) calculates by following company: Xa=(L1+L2)/2 virtual coordinates of road sign steady arm A; Ya=∮ 1, the virtual coordinates of first sequence number (virtual, length is Xa, and direction is Ya, uses when cruising in order to study) is ((L1+L2)/2, ∮ 1) in the walking so, the coordinate here adopts polar coordinates.
Step 4) mobile robot as key point, tries to achieve its current position its virtual coordinates and it is stored into memory module when receiving the closely signal of road sign steady arm, and is similar in its Coordinate Calculation and the step 3), here just not in explanation.
When this road sign steady arm, closely sender unit sends order 0X11 and notifies it to arrive the destination to the mobile robot, does not readvance the mobile robot; Mobile robot's sender unit sends second receiver (T102) of order 0X21 to the road sign steady arm, represent oneself to arrive, 360 ° of comprehensive distant signal transmitters of this road sign steady arm temporary close reach closely sender unit, open again in a period of time (after), in order to avoid the distant signal that next road sign steady arm sends is interfered as 1 minute.
The mobile robot finishes the path planning between road markings steady arm B and C, C and D, D and E, E and F, F and G, G and H and road sign steady arm H and the cradle S more in order successively behind the path planning of finishing cradle S and road sign steady arm B.
After setting and protocol definition are finished, enter next step.
Step 5) mobile robot's virtual coordinates to key point after the search of finishing all road sign steady arms is revised;
The mobile robot revises the key point coordinate in its path of cruising after finishing the path planning of whole perform region: the mobile robot moves to road sign steady arm A after receiving 360 ° of comprehensive distant signals of road sign steady arm A; Read the virtual coordinates of all key points of highway section SA, the mobile robot is successively by the motion of the orientation shown in the virtual coordinates of key point then, simultaneously distance and direction of motion are stored into memory module, when arriving last key point (key point the when mobile robot receives short-range signal) in this highway section, judge whether its virtual coordinates is the interior virtual coordinates of memory module; If the calculating that the virtual coordinates of key point is described is good; If not, illustrating in the parameter of keeping away in the barrier for the first time has deviation, then the current position point of mobile robot is stored in the memory module as newly-increased key point and with its virtual coordinates, so finish the correction of highway section SA; Continue to finish the correction of virtual coordinates of the key point in other highway sections then by this step.
Step 6) mobile robot cruises by the virtual coordinates of revised key point.
Finish the correction of virtual coordinates of key point in all 9 highway sections the mobile robot after, 360 ° of comprehensive distant signals that the mobile robot no longer receives the road sign steady arm reach closely signal, can withdraw the road sign steady arm this moment, the mobile robot reads the virtual coordinates and the motion of the key point in each highway section successively then, to finish the path of cruising of self study.
Special circumstances in mobile robot's operational process are handled:
One, obstacle avoidance is handled:
Above-mentioned steps 3) mobile robot there is not description under the obstacle situation between any two road sign steady arms, and various faults can be run into by robot in actual conditions, please refer to Figure 10 to Figure 11, obstacle is arranged (distance of detection is generally 5CM~30CM if mobile robot's obstacle detection module is sensed the place ahead, the obstacle of surveying comprises barrier and road surface hollow), the mobile robot is out of service, with this point as key point, calculate its virtual coordinates and with its storage, the original place rotates 60 ° of continuation motions more to the left or to the right then, in the obstacle process, if the mobile robot has lost the signal of current road sign steady arm, then straight line shrinks back, and up to getting back to a last key point, selects a direction to keep away barrier again; Experiment showed, that by this being kept away barrier the preferred 60 ° angle of mobile robot keeps away barrier, it is reliable for effect and algorithm is fairly simple that it keeps away barrier.The mobile robot can keep away barrier by following two modes:
A. please refer to Figure 10, the mobile robot detects obstacle at A2 point place, and the A2 point as key point, is obtained its virtual coordinates (X
A2, Y
A2) and store, turn left then 60 ° to travel forward, after A3 point place no longer detected obstacle, as key point, turned right 60 ° and obtain its virtual coordinates (X with the A3 point then this moment
A3, Y
A3) and store, an A2 that moves on between the some A3 apart from point of arrival A4 after the length, will put A4 as key point, turn right 60 ° and obtain its virtual coordinates (X
A4, Y
A4) and store, an A2 that moves on between the some A3 apart from length point of arrival A5, will put A5 as key point, turn right 60 ° and obtain its virtual coordinates (X
A5, Y
A5) and store, the 60 ° of continuation of turning left are again moved forward, thereby finish the avoidance to obstacle.
B. please refer to Figure 11, the mobile robot detects obstacle at A2 point place, and the A2 point as key point, is obtained its virtual coordinates X
A2, Y
A2) and store, turning left then 60 ° travels forward advances and still can detect obstacle behind the preset distance point of arrival A3 ', the mobile robot abandons an A ' 3 as key point, then the mobile robot retreats into key point A2 with straight line, turn right 120 ° then, the preset distance point of arrival A3 that readvances no longer detects obstacle this moment, the mobile robot as key point, obtains its virtual coordinates (X with the A3 point
A3, Y
A3) and store, the predetermined length point of arrival A4 that turns left then 60 ° to move on, and then with the A4 point as key point, obtain its virtual coordinates (X
A4, Y
A4) and store, follow 60 ° of preset distance point of arrival A5 that move on, will put A5 as key point, turn left 60 ° and obtain its virtual coordinates (X
A5, Y
A5) and store, the 60 ° of continuation of turning right are again moved forward, thereby finish the avoidance to obstacle.
Adopting the B mode to keep away in the barrier, the proal preset distance of mobile robot can be set by artificial, and the user can suitably set according to the size of indoor obstacle, can improve its efficient of cruising.
Two, the mobile robot is skidded or is blocked fault handling:
Can receive the signal that revolver tests the speed or right wheel tests the speed at acquisition module, and universal wheel tests the speed when not having signal, the mobile robot thinks that then left and right wheels is skidded or it is stuck, the mobile robot stops to travel forward, straight line retreats preset distance backward then, receives the universal wheel tachometer signal simultaneously up to acquisition module, this moment the mobile robot with this point as key point, obtain its virtual coordinates and storage, and then select a direction to travel forward.
Above content be in conjunction with concrete preferred implementation to further describing that the present invention did, can not assert that concrete enforcement of the present invention is confined to these explanations.For the general technical staff of the technical field of the invention; make some alternative or obvious modification that are equal to without departing from the inventive concept of the premise; and performance or purposes are identical, all should be considered as belonging to the scope of patent protection that the present invention is determined by claims of being submitted to.