Summary of the invention
For the defect existing in above-mentioned prior art, technical problem to be solved by this invention is to provide one, and to realize cost low, and setting height(from bottom) can regulate arbitrarily, be subject to such environmental effects little, thereby there is mobile robot's recharging device and the recharging method thereof of better versatility and dependability.
In order to solve the problems of the technologies described above, a kind of mobile robot's recharging device provided by the present invention, relates to the mobile robot who is built-in with battery, and this device comprises and is fixed on the charging pedestal landing on thing, and be fixed on the companion's pedestal on mobile robot, it is characterized in that:
Described charging pedestal has an infrared emission chamber, described infrared emission chamber is all being opened infrared ray on direction and left and right directions forward, and chamber, the both sides up and down wall in infrared emission chamber all can cut off infrared ray, in infrared emission chamber, be fixed with a perpendicular infrared division board of transmitting terminal of putting, infrared emission chamber is separated into each sub-chamber of transmitting around by the infrared division board of this transmitting terminal, in these two the sub-chambeies of transmitting, is respectively equipped with an infrared transmitter;
On described charging pedestal, be equipped with infrared signal transmission circuit, described infrared signal transmission circuit has two the infrared signal output ports that can export phase xor signal, and these two infrared signal output ports connect respectively two infrared transmitters;
Described companion's pedestal has an infrared reception cavity, described infrared reception cavity is open to infrared ray in left, front, right three directions, and can cut off infrared ray in upper and lower, rear three directions, in infrared reception cavity, be fixed with a perpendicular infrared division board of receiving terminal of putting, infrared reception cavity is separated into each sub-chamber of reception around by the infrared division board of this receiving terminal, in these two the sub-chambeies of reception, is respectively equipped with at least one infrared remote receiver;
On described companion's pedestal, be equipped with infrared signal receiving circuit, described infrared signal receiving circuit has multiple infrared signal receiving ports, and each infrared signal output port of infrared signal receiving circuit connects respectively each infrared remote receiver;
On described charging pedestal and companion's pedestal, point be equipped with can be with level charging plug, the charging socket to pluggable mode deciliter.
Further, the front end of described companion's pedestal is equipped with three sensitive switches that touch charging pedestal by bond energy, and these three sensitive switches from left to right arc interval are laid.
Further, described charging plug is fixed on charging pedestal, and charging socket is arranged on companion's pedestal, is respectively fixed with a conductive contact blade in the both ends of the surface up and down of charging plug;
Described charging socket has that two intervals are laid and just right sliding shoe up and down, and the spring moving for ordering about two sliding shoe subtends, and the opposite end of two sliding shoes is respectively fixed with a conductive contact blade.
Further, the face that caters to that two sliding shoes cater to charging plug one side is inclined-plane, and these two cloth that caters to face is set as front wide and rear narrow tubaeform.
Further, described infrared signal transmission circuit comprises emission control module, mains connection;
Described charging plug is received mains connection through a current sensor, a charging control relay, and described mains connection is received external power source;
Described emission control module has transducing signal input port, charging signals output port, and two infrared signal output ports, the transducing signal input port of emission control module is received the transducing signal output of current sensor, the charging signals output port of emission control module is received the control coil of charging control relay, and two infrared signal output ports of emission control module are received respectively two infrared transmitters.
Further, described infrared signal receiving circuit comprises reception control module, battery connecting piece;
Described charging socket is subject to electric control relay to receive battery connecting piece through one, and described battery connecting piece is received mobile robot's internal battery;
Described reception control module has the electrical signal of being subject to mouth, and multiple infrared signal receiving ports, three docking signal input ports, the electrical signal mouth that is subject to that receives control module is received the control coil that is subject to electric control relay, each infrared signal receiving port that receives control module is received respectively each infrared remote receiver, and three docking signal input ports that receive control module are received respectively three sensitive switches.
The recharging method of mobile robot's recharging device provided by the present invention, is characterized in that, the lasting transmitting infrared signal of two infrared transmitters that makes to charge on pedestal, and make the infrared signal of two infrared transmitter transmittings different;
When mobile robot need to charge, carry out following steps:
1) by each infrared remote receiver on companion's pedestal, adopt pirouette flowing mode to detect infrared docking signal, described infrared docking signal refers to two infrared signals that infrared transmitter is launched on charging pedestal;
Mobile robot detects after infrared docking signal, detects the infrared signal that whether can simultaneously receive two infrared transmitters, if can receive the infrared signal of two infrared transmitters simultaneously, goes to step 3, otherwise goes to step 2;
2) mobile robot adopts original place reciprocating rotation mode to find out to detect two critical angle of infrared docking signal, and then find out the sector region that infrared docking signal can be detected, the center line direction of this sector region is the center of infrared docking signal, then make mobile robot first turn to the just center to infrared docking signal of leading flank of companion's pedestal, rotate a centering towards the infrared transmitter direction of not receiving infrared docking signal again and adjust angle, then mobile robot again towards the dead ahead of companion's pedestal to rectilinear movement, until go to step 3 after receiving two infrared docking signals simultaneously,
Wherein, described centering adjustment angle is the predefined threshold value that is less than 60 degree;
3) mobile robot whether detect the signal strength signal intensity of two infrared docking signals of receive consistent, if institute receives that two infrared docking signal strength signal intensities are consistent, go to step 5, otherwise go to step 4;
4) mobile robot rotates towards the large side of received infrared docking signal strength signal intensity, until institute's two infrared docking signal strength signal intensities of receiving go to step 5 after consistent;
5) mobile robot moves towards self front, until go to step 6 after one of them the sensitive switch closure on companion's pedestal;
6) if be positioned at the sensitive switch closure in left side, mobile robot rotates towards right side, until go to step 7 after the sensitive switch closure in the middle of being positioned at;
If be positioned at the sensitive switch closure on right side, mobile robot rotates towards left side, until go to step 7 after the sensitive switch closure in the middle of being positioned at;
If the sensitive switch closure in the middle of being positioned at, goes to step 7;
7) charge to mobile robot's internal battery by charging plug and charging socket.
Further, mobile robot receive two infrared docking signal strength signal intensities consistent after in self front moving process, mobile robot's translational speed is inversely proportional to the infrared signal strength signal intensity of docking.
Further, the infrared signal that two infrared transmitters on charging pedestal are launched is to be superimposed upon the infrared modulated signal on high frequency carrier by low-frequency control signal.
Further, the value of described centering adjustment angle is 20 degree.
Mobile robot's recharging device provided by the invention and recharging method thereof, utilize two infrared transmitters that charge on pedestal jointly along level to the infrared docking signal of transmitting, thereby form three signal areas in charging pedestal front, robot receives infrared docking signal by the infrared remote receiver on companion's pedestal, and find the particular location of charging pedestal according to the intensity difference between affiliated signal area and received two infrared docking signals, realize the automatic butt with charging pedestal, it is low that this device is realized cost, and the setting height(from bottom) to infrared transmitter and infrared remote receiver does not limit, do not need solar obligation at robot top, structural design to robot does not limit, setting height(from bottom) can regulate arbitrarily according to the robot of different size, can be used for the robot of all size, there is better versatility, obstacle in operational environment and illumination are also less on its impact, have the advantages that dependability is high.Further, charging pedestal and companion's pedestal connect internal battery and the supporting charger of robot by connector, can, for the mobile robot who does not dispose recharging device, further expand its versatility.Further adopt be easy to arrange and job stability is high in indoor environment infrared modulated signal as docking signal, not only can mask from sunlight, fluorescent lamp, the infrared interference of heating system equipment, and infrared modulated signal can transmit byte type data message, modulation and demodulation process does not need heavy calculating yet, the through-put power of infrared modulated signal is also lower, with laser scanner, sonars etc. are compared, realize cost lower, safety in utilization is also high, can under family and office environment, work reliably, even if there is the home environment of child or pet to be also applicable to using.
Embodiment
Below in conjunction with brief description of the drawings, embodiments of the invention are described in further detail, but the present embodiment is not limited to the present invention, every employing analog structure of the present invention and similar variation thereof, all should list protection scope of the present invention in.
As Figure 1-Figure 2, a kind of mobile robot's recharging device that the embodiment of the present invention provides, relates to the mobile robot who is built-in with battery, and this device comprises and is fixed on the charging pedestal 10 landing on thing, and be fixed on the companion's pedestal 20 on mobile robot, it is characterized in that:
Described charging pedestal 10 has an infrared emission chamber 11, described infrared emission chamber 11 is open to infrared ray in left, front, right three directions, and can cut off infrared ray in upper and lower, rear three directions, in infrared emission chamber 11, be fixed with a perpendicular infrared division board 12 of transmitting terminal of putting, infrared emission chamber is separated into each sub-chamber of transmitting around by the infrared division board 12 of this transmitting terminal, in these two the sub-chambeies of transmitting, is respectively equipped with an infrared transmitter 13;
On described charging pedestal 10, be equipped with infrared signal transmission circuit, described infrared signal transmission circuit has two the infrared signal output ports that can export phase xor signal, and these two infrared signal output ports connect respectively two infrared transmitters 11;
Described companion's pedestal 20 has an infrared reception cavity 21, described infrared reception cavity 21 is all being opened infrared ray on direction and left and right directions forward, and chamber, the both sides up and down wall of infrared reception cavity 21 all can cut off infrared ray, in infrared reception cavity 21, be fixed with a perpendicular infrared division board 22 of receiving terminal of putting, infrared reception cavity is separated into each sub-chamber of reception around by the infrared division board 22 of this receiving terminal, in these two the sub-chambeies of reception, is respectively equipped with at least one infrared remote receiver 23;
On described companion's pedestal 20, be equipped with infrared signal receiving circuit, described infrared signal receiving circuit has multiple infrared signal receiving ports, and each infrared signal output port of infrared signal receiving circuit connects respectively each infrared remote receiver 23;
The front end of described companion's pedestal 20 is equipped with three sensitive switches 25 that touch charging pedestal by bond energy, and these three sensitive switches 25 from left to right arc interval are laid;
On described charging pedestal 10 and companion's pedestal 20, point be equipped with can be with level charging plug 14, the charging socket to pluggable mode deciliter, charging plug 14 be wherein fixed on charging pedestal on 10, charging socket is arranged on companion's pedestal 20, is respectively fixed with a conductive contact blade in the both ends of the surface up and down of charging plug 14;
Described charging socket comprises the each sleeve 241 being up and down separately fixed on companion's pedestal, and be movably arranged on respectively the each sliding shoe 242 up and down in upper and lower sleeve 241, two sliding shoe 242 intervals layings and just right up and down, the opposite end of two sliding shoes 242 extends respectively sleeve 241 outsides, and the opposite end of two sliding shoes 241 is respectively fixed with a conductive contact blade 243, the spring 244 that the interior sliding shoe 242 being all equipped with for ordering about in this sleeve of each sleeve 241 moves towards another sliding shoe direction, each sleeve all with this sleeve in sliding shoe have cooperatively interact deviate from the position limiting structure of sleeve for limit slippage piece entirety, the face that caters to that two sliding shoes cater to charging plug one side is inclined-plane, these two cloth that caters to face is set as front wide and rear narrow tubaeform, so that charging plug inserts.
As shown in Figure 3, in the embodiment of the present invention, described infrared signal transmission circuit comprises emission control module U11, mains connection J11, plug connector J12;
Two conductive contact blades of described charging plug are received respectively two end pin of plug connector J12, plug connector J12 receives mains connection J11 through a current sensor U12, a charging control relay JD11, and mains connection J11 receives external power source (the supporting charger of mobile robot);
Described emission control module U11 has transducing signal input port A03, charging signals output port P06, and two infrared signal output port P09, P10, the transducing signal input port A03 of emission control module U11 receives the transducing signal output end vo ut of current sensor U12, the charging signals output port P06 of emission control module U11 receives the control coil of charging control relay JD11, two infrared signal output port P09 of emission control module U11, P10 is by two electrical fitting J13, J14 receives respectively two infrared transmitter Q11, Q12(Q11, Q12 is labeled as 13 in Fig. 1),
What described emission control module U11 adopted is Arduino micro treatment module, and what current sensor adopted is that model is the linear current sensing IC of ACS712, and this current sensor is for detection of charged state.
As shown in Figure 4, in the embodiment of the present invention, described infrared signal receiving circuit comprises reception control module U21, battery connecting piece J21, socket connector J22;
Two conductive contact blades of described charging socket are received respectively two of socket connector J22 end pin, and socket connector J22 is subject to electric control relay J D21 to receive battery connecting piece J21 through one, and battery connecting piece J21 receives mobile robot's internal battery;
Described reception control module U21 has the electrical signal of being subject to mouth P06, and multiple infrared signal receiving port AD3, AD5, three docking signal input port P08, P09, P10, the electrical signal mouth P06 that is subject to that receives control module U21 receives the control coil that is subject to electric control relay J D21, receive each infrared signal receiving port AD3 of control module U21, AD5 is by two electrical fitting J23, J24 receives respectively each infrared remote receiver Q21, Q22, Q23, Q24(Q21, Q22, Q23, Q24 is labeled as 23 in Fig. 1), receive three docking signal input port P08 of control module U21, P09, P10 receives respectively three sensitive switches by an electrical fitting J25,
What described reception control module U21 adopted is Arduino micro treatment module.
As shown in Figure 5 a, in mobile robot's recharging device of the embodiment of the present invention, when two infrared transmitters 13 on charging pedestal are launched infrared signal, under the block of the infrared division board 12 of transmitting terminal, the overlay area of infrared signal is divided into A1, A2, tri-regions of A3 from left to right, the A1 region in left side only has the signal of left infrared transmitter 13, and the A3 region on right side only has the signal of right infrared transmitter 13, and middle A2 region exists the signal of two infrared transmitters 13 simultaneously.
The recharging method of mobile robot's recharging device that the embodiment of the present invention provides, is characterized in that, the lasting transmitting infrared signal of two infrared transmitters that makes to charge on pedestal, and make the infrared signal of two infrared transmitter transmittings different;
When mobile robot need to charge, carry out following steps:
1) by each infrared remote receiver on companion's pedestal, adopt pirouette flowing mode to detect infrared docking signal, described infrared docking signal refers to two infrared signals that infrared transmitter is launched on charging pedestal;
Mobile robot detects after infrared docking signal, detects the infrared signal that whether can simultaneously receive two infrared transmitters, if can receive the infrared signal of two infrared transmitters simultaneously, goes to step 3, otherwise goes to step 2;
2) now the leading flank of companion's pedestal towards charging pedestal, and companion's pedestal is positioned at charging pedestal left side and can only receives the A1 region of left infrared transmitter signal, or be positioned at charging pedestal right side and can only receive the A3 region of right infrared transmitter signal, because the signal of left and right infrared transmitter transmitting is different, so robot can judge and be currently located at A1 or A3 region according to received infrared signal content;
Mobile robot adopts original place reciprocating rotation mode to find out to detect two critical angle of infrared docking signal, and then find out the sector region that infrared docking signal can be detected, the center line direction of this sector region is the center of infrared docking signal, then make mobile robot first turn to the just center to infrared docking signal of leading flank of companion's pedestal, rotate a centering towards the infrared transmitter direction of not receiving infrared docking signal again and adjust angle, it is the predefined threshold value that is less than 60 degree that this centering is adjusted angle, its preferred value is 20 degree, then mobile robot again towards the dead ahead of companion's pedestal to rectilinear movement, until go to step 3 after receiving two infrared docking signals simultaneously,
Such as, the infrared docking signal that mobile robot receives is from left infrared transmitter, infrared transmitter direction is rotated a centering and is adjusted angle to the right, and the infrared docking signal that mobile robot receives is from right infrared transmitter, and infrared transmitter direction is rotated a centering and adjusted angle left;
As shown in Figure 5 b, suppose that mobile robot's current location R is positioned at charging pedestal left side and can only receives the A1 region of left infrared transmitter signal, the leading flank of companion's pedestal is just to pointing to the direction RC of infrared docking signal center, mobile robot rotates a centering towards right infrared transmitter direction and adjusts after angle θ, the leading flank of companion's pedestal is just to direction RB, the A2 region that this direction RB can receive the infrared signal of two infrared transmitters in the middle of pointing to simultaneously, then mobile robot moves linearly along direction RB, until enter the infrared overlay area A2 that can receive two infrared docking signals simultaneously, if mobile robot can only receive in the A3 region of right infrared transmitter signal in charging pedestal right side, the centering that mobile robot rotates is adjusted the identical but opposite direction of angle,
3) now the leading flank of companion's pedestal is towards charging pedestal, and companion's pedestal is positioned at the A2 region that can simultaneously receive two infrared transmitter signals;
Whether the signal strength signal intensity that mobile robot detects two infrared docking signals of receive is consistent, if institute receives that two infrared docking signal strength signal intensities are consistent, goes to step 5, otherwise goes to step 4;
4) now companion's pedestal is positioned at the dead ahead of charging pedestal leading flank side in the companion's pedestal shown in Fig. 6 a or Fig. 6 c state to charging pedestal;
Mobile robot rotates towards the large side of received infrared docking signal strength signal intensity, until institute's two infrared docking signal strength signal intensities of receiving go to step 5 after consistent;
5) now companion's pedestal is positioned at the dead ahead of charging pedestal the just state to charging pedestal of leading flank in the companion's pedestal shown in Fig. 6 b;
Mobile robot moves towards self front, until go to step 6 after one of them the sensitive switch closure on companion's pedestal, mobile robot's translational speed is inversely proportional to the infrared signal strength signal intensity of docking, to reduce the impact of mobile robot to charging pedestal;
6) if be positioned at the sensitive switch closure in left side, show that charging socket does not dock completely with charging plug, mobile robot rotates towards right side, until go to step 7 after the sensitive switch closure in the middle of being positioned at;
If be positioned at the sensitive switch closure on right side, show that charging socket does not dock completely with charging plug, mobile robot rotates towards left side, until go to step 7 after the sensitive switch closure in the middle of being positioned at;
If the sensitive switch closure in the middle of being positioned at, shows that charging socket docks completely with charging plug, goes to step 7;
7) charge to mobile robot's internal battery by charging plug and charging socket.
For security reasons, only have after charging socket docks completely with charging plug, conductive contact blade on charging plug just has charging current to be passed through, for realizing this safety function, the low-voltage DC signal function of one+5v is on charging socket charging contact, after charging socket docks completely with charging plug, emission control module on charging plug detects this+the 5v signal of telecommunication, emission control module is controlled the switch cutter closure of charging control relay immediately, makes charging plug and external power source (the supporting charger of mobile robot) conducting.
In the embodiment of the present invention, the infrared signal that two infrared transmitters on charging pedestal are launched is to be superimposed upon for example, infrared modulated signal on high frequency carrier (38kHz) by low-frequency control signal, each infrared remote receiver on companion's pedestal be tuned to the frequency consistent with high frequency carrier, to neglect environmental noise, avoid the infrared interference of the environmental factors such as sunlight, bulb, heater.
The infrared modulated signal that infrared transmitter is launched belongs to phase place distance modulated, and the signal format of this infrared modulated signal is: start bit+address bit+command bit+cut-off position; Wherein, start bit adopts continuous 4ms high level+1ms low level statement, cut-off position adopts continuous 2ms high level statement, address bit adopts 4 bit statements, command bit adopts 6 bit statements, binary one adopts continuous 1ms high level+2ms low level statement, and Binary Zero adopts continuous 1ms high level+3ms low level statement; Making to charge in the infrared modulated signal of two infrared transmitters transmitting on pedestal comprises different character strings, and what can make mobile robot tell to receive is the signal which infrared transmitter is launched.
The infrared modulated signal example schematic diagram that includes string of binary characters 1001100100 of being launched for infrared transmitter as Fig. 7, F01 region in this figure is start bit, F02 region is address bit, F03 region is command bit, F04 region is cut-off position, B1 region representation binary one, B2 region representation Binary Zero.
In the embodiment of the present invention, charging socket and charging plug all adopt conductive contact blade to realize face contact, and utilize spring to increase joint reliability, firm to ensure that charging socket engages with charging plug.
The embodiment of the present invention can be adjusted according to the mobile robot of different size the setting height(from bottom) of charging pedestal and companion's pedestal, applicable to the mobile robot of plurality of specifications.
The embodiment of the present invention has been carried out recharging test on existing multiple mobile robot (such as existing difference mobile robot Pioneer 3-DX, existing omni-directional mobile robots Rio), has all obtained better effects;
Wherein, the internal battery of existing difference mobile robot Pioneer 3-DX is traditional lead-acid battery, the output specification of the supporting charger that manufacturer provides is 14 volts, 4 amperes of direct currents, when in test process, this mobile robot is placed in different starting positions, first capital moves to the A2 region that two infrared transmitter signals can be received in charging pedestal dead ahead simultaneously, then moves linearly until charging socket docks completely with charging plug towards charging pedestal;
Fig. 8 is the mobile robot motion track figure of mobile robot's recharging device of the embodiment of the present invention while being arranged on existing difference mobile robot Pioneer 3-DX test, the horizontal number axis that in this figure, X-axis and Y-axis are position coordinates and vertical number axis, T0 is charging pedestal position, T1, T2, T3, T4, T5, T6 is the initial position at each the robot place in test, as shown in Figure 8, no matter mobile robot is from what position, first capital moves to the A2 region that two infrared transmitter signals can be received in charging pedestal dead ahead simultaneously, then move linearly until charging socket docks completely with charging plug towards charging pedestal.
Existing omni-directional mobile robots Rio has 4 driving wheels, each wheel possesses the direct locomotivity of side direction, this mobile robot is equipped with 14.4 volts, the lithium ion battery of 0.38 kilowatt hour, when mobile robot's recharging device of the embodiment of the present invention is arranged on the upper test of this mobile robot, the motion track of this mobile robot's motion track and difference mobile robot Pioneer 3-DX is similar.
Test result shows no matter be differential motion robot or omni-directional mobile robots, and what no matter be equipped with is traditional lead acid accumulator or lithium ion battery, and mobile robot's recharging device of the embodiment of the present invention all can be worked normally.