AGV lifting corrective system and method thereof based on non-guide path
Technical field
The invention belongs to the AGV technical field, especially a kind of AGV lifting corrective system and method thereof based on non-guide path.
Background technology
AGV is a kind of unpiloted full-automatic carrier, can be applicable to intelligent storage or intelligent parking lot, its working method is: goods is placed on pallet, pallet is placed on the pallet storing district of assigned address, the pallet storing district is an appointed area on the AGV guide path, be laid with two-dimension code label on the ground at this center, appointed area, before AGV lifts goods, by the two-dimension code label correction self of pallet storing district center and the pose of pallet, in the time of before AGV arrival impact point puts down goods, to proofread and correct the pose of cargo storage by the two-dimension code label at center, impact point ground too.The above is the disposal route of AGV under normal circumstances, but when fortuitous event occurring, for example, when anxious the stopping or pallet storing district while not yet using of breaking down, pallet now and the goods of delivery thereof probably are parked on a random site that there is no a Quick Response Code, how to make AGV in the situation that do not guide label, does pose according to the rules normally enter the pallet entrance and automatically completed the pose correction of AGV and pallet before the lifting pallet? the traditional work pattern is the method that relies on the artificial visually examine: the related personnel gets into below the AGV dolly, face upward the head and survey site error and the angular error between AGV dolly and pallet, then, get back on computer operation table, manually input corrective command and correction parameter by means of the position and attitude error data in memory and send to the AGV controller on computer operation table, the order of AGV dolly implementation controller, complete the correction work of initial pose with this.The method deficiency is: adopt the method for manual synchronizing, workload is heavy, the activity duration is long.
Summary of the invention
The object of the invention is to overcome the deficiencies in the prior art, a kind of AGV lifting corrective system and method thereof based on non-guide path is provided, the problems such as the workload that relies on artificial contraposition to bring is heavy for solving, activity duration length.
The present invention solves existing technical matters and takes following technical scheme to realize:
A kind of AGV lifting corrective system based on non-guide path, comprise cargo pallet, be arranged on the rule schema shape code register control on the AGV dolly, be arranged on rule schema shape code code reader and the electric magnetic railings ruler at AGV car body center, be arranged on rule schema shape code label and the magnetic nail of cargo pallet lower surface, rule schema shape code register control is connected with electric magnetic railings ruler with rule schema shape code code reader respectively, the rule schema shape code label that rule schema shape code code reader reads on cargo pallet sends rule schema shape code register control to, the electricity magnetic railings ruler detects the magnetic nail on cargo pallet and sends testing result to rule schema shape code register control, rule schema shape code register control is realized the pose calibration function of AGV dolly for cargo pallet beyond the pallet storing district to receiving the data analysis processing.
And described rule schema shape code label is two-dimension code label, described rule schema shape code code reader is the Quick Response Code code reader.
And described rule schema shape code code reader and electric magnetic railings ruler are installed in the square opening at AGV car body center and, towards cargo pallet, electric magnetic railings ruler is positioned at the surrounding of rule schema shape code code reader.
And described rule schema shape code label is arranged on the center of cargo pallet bottom, described magnetic nail is distributed in the surrounding of rule schema shape code label, and the square region impaled by the magnetic nail is the vision trigger region.
And, described rule schema shape code register control is connected and composed by microprocessor, communication interface and AGV driver module, this microprocessor is connected and realizes data acquisition function with electric magnetic railings ruler with rule schema shape code code reader respectively by communication interface, and this microprocessor is connected with the AGV driver module and realizes the driving control function to AGV.
A kind of bearing calibration of the AGV lifting corrective system based on non-guide path comprises the following steps:
Step 1: the electric magnetic railings ruler that is installed on AGV car body center enters the vision trigger region under cargo pallet in company with car body;
Step 2: electric magnetic railings ruler is issued rule schema shape code register control by signal after collecting the vision trigger pip of vision trigger region, and the moment of electric magnetic railings ruler collection signal is the moment that AGV enters the vision trigger region;
Step 3: rule schema shape code register control sends acquisition to rule schema shape code code reader after receiving the vision trigger pip;
The rule schema shape code code reader at step 4:AGV car body center gathers the regular code image at cargo pallet lower surface center and collection signal is fed back to rule schema shape code register control;
Step 5: rule schema shape code register control is proofreaied and correct the position and attitude error between AGV car body central point and pallet central point according to the picture signal of rule schema shape code code reader feedback;
Step 6:AGV opens jacking apparatus, jacking apparatus is aimed at the cargo pallet registration holes.
And the concrete disposal route of described step 5 is:
(1) set up following three coordinate systems: image coordinate system (u, v), dolly coordinate system (x dolly, y dolly), world coordinate system (the x world, the y world);
(2) calculate under the dolly coordinate system AGV with respect to deviation angle and the deviation position of the rule schema shape code label at cargo pallet lower surface center;
(3) computation rule graphic code label is with respect to deviation position and the deviation angle of world coordinate system;
(4) calculate deviation angle and the deviation position of AGV with respect to world coordinate system, thereby obtain rectification position and the angle of AGV with respect to cargo pallet.
Advantage of the present invention and good effect are:
The present invention is by following closely and arrange the visual pattern trigger region at cargo pallet lower surface center installation rule code label and magnetic, at AGV dolly center installation rule graphic code code reader, with electric magnetic railings ruler and with rule schema shape code register control, be connected, realize AGV and cargo pallet to bit function, improved AGV for the automaticity in the pallet lifting process of any random site beyond the pallet storing district, solved the workload that manual work brings heavy, the problem that activity duration is long, reduced the error of AGV with respect to cargo pallet, the reliability and stability of AGV transportation have been guaranteed.
The accompanying drawing explanation
Fig. 1 is system connection diagram of the present invention;
The schematic diagram that concerns that Fig. 2 is AGV and cargo pallet;
The installation that Fig. 3 is electric magnetic railings ruler and rule schema shape code code reader and AGV car body concerns schematic diagram (vertical view);
The installation that Fig. 4 is electric magnetic railings ruler and rule schema shape code code reader and AGV car body concerns schematic diagram (side view);
The structural representation that Fig. 5 is the cargo pallet bottom;
The processing flow chart that Fig. 6 is this bearing calibration;
Fig. 7 is used artificial operating grip to proofread and correct AGV pose schematic diagram before AGV enters the pallet entrance;
Fig. 8 is the schematic diagram that vision triggers buffer zone;
Fig. 9 is the reference position schematic diagram that the rule schema shape code starts to gather image;
In figure, the 1-1:AGV car body; The 1-2:AGV wheel; The 1-3:AGV lifting body; The 1-4:AGV square opening; 1-5: electric magnetic railings ruler; 1-6: rule schema shape code register control; 1-7: code reader support; 1-8: rule schema shape code code reader; 2-1: cargo pallet; 2-2: pallet registration holes; 2-3: pallet leg; 2-4: vision trigger region; 2-5: magnetic nail; 2-6: rule schema shape code label; 5: the manually-operated handle.
Embodiment
Below in conjunction with accompanying drawing, the embodiment of the present invention is further described.
A kind of AGV lifting corrective system based on non-guide path, as shown in Figure 1, comprise cargo pallet, be arranged on the rule schema shape code register control on the AGV dolly, the rule schema shape code code reader that is arranged on AGV car body center and electric magnetic railings ruler, the rule schema shape code label that is arranged on the cargo pallet lower surface and magnetic nail.In the present embodiment, rule schema shape code label is two-dimension code label, and rule schema shape code code reader is the Quick Response Code code reader.Described rule schema shape code register control is connected and composed by microprocessor, communication interface and AGV driver module, this microprocessor is connected and realizes data acquisition function with electric magnetic railings ruler with rule schema shape code code reader respectively by communication interface, this microprocessor is connected with the AGV driver module and realizes the driving control function to AGV, and this communication interface can be the interfaces such as network interface, USB interface or 1394 interfaces.Described rule schema shape code register control is connected with electric magnetic railings ruler with rule schema shape code code reader by communication interface, this rule schema shape code register control is for reading the rule schema shape code label of cargo pallet lower surface and sending rule schema shape code register control to, described electric magnetic railings ruler is followed closely and sends testing result to rule schema shape code register control for detection of the magnetic of cargo pallet lower surface, rule schema shape code register control is analyzed and is controlled the AGV driver module to the rule schema shape code image that reads and electric magnetic railings ruler testing result and moved, thereby realize the pose calibration function of AGV dolly for the random site top tray beyond the pallet storing district.
As shown in Figures 2 to 4, AGV consists of car body 1-1, wheel 1-2 and lifting body 1-3, in the square opening of AGV car body center, 1-4 is equipped with electric magnetic railings ruler 1-5 and the rule schema shape code code reader 1-8 towards cargo pallet, by the electric magnetic railings ruler of four direction, constitutes combined electrical magnetic railings ruler group.Rule schema shape code code reader is arranged on the inner ring of magnetic railings ruler by code reader support 1-7, rule schema shape code register control (master controller) 1-6 is installed on the rear end of vehicle bottom.
As shown in Figure 5, be provided with four registration holes 2-2 and four cargo pallet leg 2-3 in the bottom of cargo pallet 2-1, the be laid in center of cargo pallet bottom of rule schema shape code label 2-6, in the surrounding of rule schema shape code label, magnetic nail 2-5 is installed, the direction that each group magnetic nail corresponding A GV dolly enters pallet, the square region impaled by the magnetic nail is vision trigger region 2-4, this vision trigger region can be used for directions and central point, and described cargo pallet can be parked on the random site beyond the pallet storing district.
A kind of AGV lifting bearing calibration based on non-guide path, as shown in Figure 6:
Step 1: the electric magnetic railings ruler that is installed on AGV car body center enters the vision trigger region under cargo pallet in company with car body;
As shown in Figure 7, in figure, 1-0 is AGV dolly upper surface, before the AGV dolly enters cargo pallet, rely on the manually-operated handle to control the AGV dolly and normally enter the pallet entrance, its control mode is: by manually-operated handle 5, to rule schema shape code register control (master controller), send order, master controller sends order to the AGV driver module again,, thereby thereby by pose 1. to pose 2. the relative position of adjusting AGV dolly and pallet entrance makes AGV, the AGV dolly after adjustment can normally enter the pallet entrance;
Step 2: electric magnetic railings ruler is issued rule schema shape code register control by signal after collecting the vision trigger pip of vision trigger region, and the moment of electric magnetic railings ruler collection signal is the moment that AGV enters the vision trigger region:
As shown in Figure 8, in the AGV traveling process, default vision triggers buffer zone, and it is the stretch journey that AGV is about to enter the vision trigger region that this vision triggers buffer zone.Pass by time of this buffer zone of AGV dolly should equal time, electric magnetic railings ruler that electric magnetic railings ruler gathers magnetic signal and sends the time of image acquisition order, the temporal summation that camera receives the image acquisition order to time, the master controller of master controller feedback trigger pip to camera.
Step 3: rule schema shape code register control sends acquisition to rule schema shape code code reader after receiving the vision trigger pip;
The rule schema shape code code reader at step 4:AGV car body center gathers the regular code image at cargo pallet lower surface center and collection signal is fed back to master controller;
As shown in Figure 9, rule schema shape code code reader starts the photographic images position: when the electric magnetic railings ruler of AGV dolly be positioned at its corresponding magnetic nail group directly over the time, the rule schema shape code code reader that is installed on AGV car body center starts the task that carries out image gathers, and image pick-up signal is fed back to rule schema shape code register control.
Step 5: rule schema shape code register control is proofreaied and correct the position and attitude error between AGV car body central point and pallet central point according to the picture signal of rule schema shape code code reader feedback.
In this step, the detailed method of relevant AGV vision location has a detailed description in patented claim formerly the applicant, as " indoor mobile robot positioning system and method based on Quick Response Code " (number of patent application: 201210186563.5), and " mobile robot positioning system of rule-based graphic code composite label and method " (number of patent application is 201310017927.1), do not repeat them here, the method for only register control being proofreaied and correct to the position and attitude error between AGV car body and cargo pallet according to decoded information is summarized as follows:
(1) set up following three coordinate systems: image coordinate system (u, v), dolly coordinate system (x dolly, y dolly), world coordinate system (the x world, the y world);
(2) calculate under the dolly coordinate system AGV with respect to deviation angle and the deviation position of the rule schema shape code label at cargo pallet lower surface center;
(3) computation rule graphic code label is with respect to deviation position and the deviation angle of world coordinate system;
(4) calculate deviation angle and the deviation position of AGV with respect to world coordinate system, thereby obtain rectification position and the angle of AGV with respect to cargo pallet.
Step 6:AGV opens jacking apparatus, jacking apparatus is aimed at the cargo pallet registration holes.
It is emphasized that; embodiment of the present invention is illustrative; rather than determinate; therefore the present invention includes and be not limited to the embodiment described in embodiment; every other embodiments that drawn by those skilled in the art's technical scheme according to the present invention, belong to the scope of protection of the invention equally.