Summary of the invention
In view of this, the present invention proposes a kind of control method for cargo transfer robot, wherein the cargo is carried
Robot includes moving cell, cargo picking and placing unit and lifting unit, and the cargo picking and placing unit and lifting unit are by the fortune
Moving cell carrying, the lifting unit are configured to that the cargo picking and placing unit can be raised and lowered, and the control method includes: to connect
It receives the work order of object transfer robot;According to the work order, the moving cell of the cargo transfer robot is controlled,
The shelf of first position are moved into, the cargo for being located at the first height is taken out;According to the work order, the cargo is controlled
The moving cell of transfer robot is moved into the shelf of the second position, and the cargo is placed into the second position
Shelf the second height at, wherein during the cargo transfer robot is moved to the second position from first position,
The cargo picking and placing unit is raised or lowered to second height from the first height by the lifting unit.
According to an aspect of the present invention, described the step of taking out the cargo for being located at the first height includes: the measurement goods
Object picking and placing unit controls the protruding distance L of the cargo picking and placing unit to the distance L1 of the cargo, to be located at described in taking-up
The cargo of first height, wherein L=L1+L2, L2 are the length of the pallet of the cargo or the carrying cargo.
According to an aspect of the present invention, the lifting unit is configured to that institute is raised and lowered according to preset trace information
Cargo picking and placing unit is stated, wherein preferably, the lifting unit is configured to reach the second position in the cargo transfer robot
When, the cargo picking and placing unit is raised or lowered to second height from the first height.
According to an aspect of the present invention, the trace information include it is continuous it is even accelerate, at the uniform velocity with the even decelerating phase.
According to an aspect of the present invention, the cargo transfer robot is moved to the second position, by the cargo
When being placed into the shelf of the second position, the cargo picking and placing unit is static in vertical direction.
The invention further relates to a kind of cargo transfer robots, comprising: moving cell;Cargo picking and placing unit, the cargo take
It puts unit to be carried by the moving cell, and is configured to that cargo can be taken out or places goods on shelf;Lifting unit,
The lifting unit is carried by the moving cell, and is configured to that the cargo picking and placing unit can be raised and lowered;And control
Unit, described control unit is coupled with the moving cell, cargo picking and placing unit and lifting unit, and is configured to that this hair can be performed
Bright control method.
According to an aspect of the present invention, the hopper robot further includes camera or radar, the camera or thunder
Up to being configured to can measure the cargo picking and placing unit at a distance from the cargo.
According to an aspect of the present invention, the control device be configured to can according to the camera or radar surveying away from
From the control cargo picking and placing unit to take out cargo.
According to an aspect of the present invention, the lifting unit is configured to that institute is raised and lowered according to preset trace information
Cargo picking and placing unit is stated, wherein preferably, the lifting unit is configured to reach the second position in the cargo transfer robot
When, the cargo picking and placing unit is raised or lowered to second height from the first height.
According to an aspect of the present invention, the trace information include it is continuous it is even accelerate, at the uniform velocity with the even decelerating phase.
According to an aspect of the present invention, the control device is configured to: when the cargo transfer robot is moved to institute
When stating the second position, the cargo being placed into the shelf of the second position, keep the cargo picking and placing unit in vertical side
To static.
According to an embodiment of the invention, the movement of yoke and the movement of cargo transfer robot are linked, save
Yoke individually goes up and down the time of execution, to improve the time for taking, putting goods.
Specific embodiment
Hereinafter, certain exemplary embodiments are simply just described.As one skilled in the art will recognize that
Like that, without departing from the spirit or scope of the present invention, described embodiment can be modified by various different modes.
Therefore, attached drawing and description are considered essentially illustrative rather than restrictive.
In the description of the present invention, it is to be understood that, term " center ", " longitudinal direction ", " transverse direction ", " length ", " width
Degree ", " thickness ", " go up ", " under ", " preceding ", " afterwards ", " left side ", " right side ", " heavily fortified point, and directly ", " level ", " top ", " bottom ", " is interior ", " outside ", "
Clockwise ", " counterclockwise " wait the orientation or positional relationship of instructions to be based on the orientation or positional relationship shown in the drawings, merely to
Convenient for description the present invention and simplify description, rather than the device or element of indication or suggestion meaning must have a particular orientation,
It is constructed and operated in a specific orientation, therefore is not considered as limiting the invention.In addition, term " first ", " second " are only
For descriptive purposes, it is not understood to indicate or imply relative importance or implicitly indicates the number of indicated technical characteristic
Amount." first " is defined as a result, the feature of " second " can explicitly or implicitly include one or more spy
Sign.In the description of the present invention, " multiple " are meant that two or more, unless otherwise specifically defined.
In the description of the present invention, it should be noted that unless otherwise clearly defined and limited, term " installation ", " phase
Even ", " connection " shall be understood in a broad sense, for example, it may be being fixedly connected, may be a detachable connection, or be integrally connected: can
To be mechanical connection, it is also possible to be electrically connected or can mutually communicate;It can be directly connected, it can also be by between intermediary
It connects connected, can be the connection inside two elements or the interaction relationship of two elements.For the ordinary skill of this field
For personnel, the specific meanings of the above terms in the present invention can be understood according to specific conditions.
In the present invention unless specifically defined or limited otherwise, fisrt feature second feature its " upper " or it " under "
It may include that the first and second features directly contact, also may include that the first and second features are not direct contacts but pass through it
Between other characterisation contact.Moreover, fisrt feature second feature " on ", " top " and " above " include first spy
Sign is right above second feature and oblique upper, or is merely representative of first feature horizontal height higher than second feature.Fisrt feature exists
Second feature " under ", " lower section " and it is " following " including fisrt feature right above second feature and oblique upper, or be merely representative of
First feature horizontal height is less than second feature.
Following disclosure provides many different embodiments or example is used to realize different structure of the invention.In order to
Simplify disclosure of the invention, hereinafter the component of specific examples and setting are described.Certainly, they are merely examples, and
And it is not intended to limit the present invention.In addition, the present invention can in different examples repeat reference numerals and/or reference letter,
This repetition is for purposes of simplicity and clarity, itself not indicate between discussed various embodiments and/or setting
Relationship.In addition, the present invention provides various specific techniques and material example, but those of ordinary skill in the art can be with
Recognize the application of other techniques and/or the use of other materials.
Hereinafter, preferred embodiments of the present invention will be described with reference to the accompanying drawings, it should be understood that preferred reality described herein
Apply example only for the purpose of illustrating and explaining the present invention and is not intended to limit the present invention.
Fig. 1 shows a kind of control method 100 for cargo transfer robot according to a first embodiment of the present invention.The
The control method 100 of one embodiment is applicable to all kinds or types of goods transfer robot.The usual cargo transfer robot
Including moving cell, cargo picking and placing unit and lifting unit.Moving cell for example including chassis, frame, driving wheel, driven wheel,
One or more of motor.Chassis and frame can be used for carrying all parts, and the motor drive driving wheel drives entire
The walking of cargo transfer robot, the various movements such as advanced, retreated, turned.If necessary, moving cell can also include from
Driving wheel.Cargo picking and placing unit and lifting unit are carried by the moving cell.Cargo picking and placing unit such as mechanical arm or yoke
Device can be used for grabbing cargo.Lifting unit is configured to be raised and lowered cargo picking and placing unit to different height, such as can
To be the structure of rail types or the structure of chain conveyer type.Certainly, cargo transfer robot includes control unit, and control is single
Member is coupled with moving cell, cargo picking and placing unit and lifting unit, controls the operation of each section.Control unit can be with other portions
Part integrates, and is also possible to individual, external control unit, is communicatively coupled with other component.These are all in the present invention
Protection scope in.
As shown in Figure 1, receiving the work order of cargo transfer robot in step S101.Such as cargo transfer robot
Control unit receive the work order.According to specific working condition, work order may include various information, for example,
One work order may include the primary information for carrying task, such as cargo is in which height on which shelf, to remove
Which height etc. of which shelf transported to.The present invention is not limited to the particular contents of work order.Receive a work order
Later, if necessary, which can be parsed, to obtain the specifying information content of carrying task.
The moving cell of the cargo transfer robot is controlled, is moved it according to the work order in step S102
To the shelf of first position, the cargo for being located at the first height is taken out.It would generally include target in work order according to described above
Cargo is in which shelf, the position of shelf, specific cargo height etc..After knowing these information, by controlling machine
Cargo transfer robot is moved to target shelf, and grabs target by cargo picking and placing unit by the moving cell of device people
Cargo.Cargo transfer robot can be moved to the shelf of first position by a variety of methods, such as be led by computer vision
The modes such as boat, inertial navigation, electromagnetic navigation, the present invention is not limited to modes of specifically navigating.
In step S103, after grabbing target goods, continue to control the fortune of cargo transfer robot according to work order
Moving cell, is moved into the shelf of the second position, and the cargo is placed into the second high of the shelf of the second position
At degree.Wherein, during the cargo transfer robot is moved to the second position from first position, the lifting unit will
The cargo picking and placing unit is raised or lowered to second height from the first height.
According to a preferred implementation, after the cargo transfer robot is moved to the second position, by institute
During stating the shelf that cargo is placed into the second position, the cargo picking and placing unit is static in vertical direction.In this way,
After the movement in place of cargo transfer robot, other elapsed time is not needed to adjust the height of cargo picking and placing unit.
Described the step of taking out the cargo for being located at the first height for example, measure the cargo picking and placing unit to the goods
The distance L1 of object controls the protruding distance L of the cargo picking and placing unit, to take out the cargo for being located at the first height,
Middle L=L1+L2, L2 are the length of the pallet of the cargo or the carrying cargo.
The lifting unit is configured to that the cargo picking and placing unit is raised and lowered according to preset trace information.It is wherein excellent
Choosing, the lifting unit is configured to when the cargo transfer robot reaches the second position, by the cargo picking and placing unit
Second height is raised or lowered to from the first height.Such as control unit is moved to second calculating from first position
The required time is set, while calculating the difference in height between the first height and the second height.By adjusting the rail of lifting unit
Mark information, so that cargo picking and placing unit is also gone up and down in place while cargo transfer robot reaches the second position.
A preferred implementation according to the present invention, the trace information subtract including continuous even acceleration, at the uniform velocity with even
The fast stage.It is specific as shown in Figure 3.
Control method 100 according to a first embodiment of the present invention, the movement of cargo picking and placing unit such as yoke and robot
Movement is linked, and is saved yoke and is individually gone up and down the time of execution, to save the time for taking, putting goods.
A kind of cargo transfer robot 200 of second embodiment of the invention is described below with reference to Fig. 2.Cargo transfer robot
200 include: moving cell, cargo picking and placing unit, lifting unit and control unit.Each unit is described below in detail.
Pedestal 202 and wheel 201 and unshowned motor of the moving cell for example including cargo transfer robot.Bottom
Seat is for carrying all parts of robot.Motor can drive wheel 201 to drive entire cargo transfer robot 200 to do respectively
Kind movement, such as advance, it retreats, turning etc..
According to a preferred implementation, cargo picking and placing unit includes yoke 203, telescope motor 204 and yoke platform
208.The cargo picking and placing unit is carried by the moving cell, and is configured to that cargo can be taken out from shelf or is put cargo
It sets on shelf.Telescope motor 204 can drive yoke 203 to stretch out or retract.Such as when needing to grab cargo, stretch electricity
Machine 204 drives yoke 203 to stretch out a distance, reaches the lower section of target goods, then yoke 203 is driven to retract, cargo is received
It returns and is placed on yoke platform 208.Yoke 203, telescope motor 204 and yoke platform 208 are one of cargo picking and placing unit
Preferred implementation, the invention is not limited thereto.Those of ordinary skill is envisaged that other implementations, for example, by using
Mechanical arm, gripper mode pick and place cargo, these are within.
Lifting unit is carried by the moving cell, and is configured to that the cargo picking and placing unit can be raised and lowered, and is arrived
Up to certain object height.As shown in Fig. 2, lifting unit includes chain 206 and lifting electricity in a preferred implementation
Machine 205, cargo picking and placing unit (such as yoke 203, telescope motor 204 and yoke platform 208) are fixed on chain 206, thus
When the rotation of 205 drive chain 206 of lifting motor, the height of cargo picking and placing unit can adjust variation therewith.Those of ordinary skill
It is also conceivable that other implementations of lifting unit, such as realized by guide rail structure, these are all in guarantor of the invention
It protects in range.
Control unit is, for example, the central controller of cargo transfer robot, controls the integrated operation of robot.Control is single
It is first to be coupled with the moving cell, cargo picking and placing unit and lifting unit, and being configured to can be in the cargo robot from
During one position is moved to the second position, controls the lifting unit and increase the cargo picking and placing unit from the first height
Or it is reduced to second height.
According to a preferred implementation, the control device is configured to: the cargo transfer robot is moved to institute
After stating the second position, during the cargo to be placed into the shelf of the second position, the cargo picking and placing unit is kept
It is static in vertical direction.
According to a preferred implementation, the cargo transfer robot further includes camera or radar 209, described to take the photograph
As head or radar 209 are configured to can measure the cargo picking and placing unit at a distance from the cargo.Camera or radar 209 and control
Device coupling processed, therefore control device can precisely control the goods according to the camera or the distance of radar surveying
Object picking and placing unit takes out cargo.A preferred implementation according to the present invention, cargo picking and placing unit can be yoke device.Fork
Arm assembly usually when taking out cargo, needs to stretch out yoke a distance to the lower section of cargo.Therefore it takes out high positioned at first
The step of cargo of degree can include: measure the cargo picking and placing unit to the distance L1 of the cargo, control the cargo and pick and place
The protruding distance L of unit, to take out the cargo for being located at the first height, wherein L=L1+L2, L2 are the cargo or hold
Carry the length of the pallet of the cargo.The cargo picking and placing unit can be measured by way of radar or camera to institute
State the distance of cargo.
According to a preferred implementation, the lifting unit is configured to that institute is raised and lowered according to preset trace information
Cargo picking and placing unit is stated, wherein preferably, the lifting unit is configured to reach the second position in the cargo transfer robot
When, the cargo picking and placing unit is raised or lowered to second height from the first height.
Fig. 3 shows a preferred embodiment of desired guiding trajectory information, wherein the trace information includes continuous even acceleration
Stage I, constant velocity stage II and even decelerating phase III.According to a preferred implementation, control unit is being calculated from first
Time t required for being moved to the second position is set, while calculating the difference in height h between the first height and the second height.Pass through
The trace information (such as acceleration or maximum speed by adjusting cargo picking and placing unit track) for adjusting cargo picking and placing unit, makes
It is also t that cargo picking and placing unit movement h, which is obtained, apart from the required time.The second position is reached in cargo transfer robot to realize
Meanwhile cargo picking and placing unit is also gone up and down in place.
A preferred implementation according to the present invention, the control device are configured to: when the cargo transfer robot
When being moved to the second position, the cargo being placed into the shelf of the second position, the cargo picking and placing unit is kept
It is static in vertical direction.
The course of work of cargo transfer robot of the invention is described below with reference to Fig. 3 and Fig. 4.
Such as Fig. 4, camera or radar 209 when yoke platform 208 is located at shelf first layer front position, in front of yoke
The distance L1 (such as two dimensional code is directed at come ranging by radar range finding or camera) of pallet is read, it is flexible by executing
Motor 204 makes 203 outreach L of yoke (wherein, L=L1+L2, L2 are pallet length), then executes lifting motor 205 and drives
208 lifting height h of yoke platform, executing telescope motor later returns to zero yoke, can get cargo on yoke platform 208.
After obtaining first layer cargo, cargo is put into the third layer of another shelf, robot is moved first,
It is high from shelf first layer according to trajectory time (robot mobile time) planning yoke platform of mobile phase when mobile beginning
Degree H1 rises to shelf third layer height H2 trace information, and trace information mainly includes the acceleration in each sampling period, speed
And location information, such as Fig. 4.In moving process, lifting motor is operated according to the trace information planned in advance, lifting motor is logical
Crossing chain conveyer drives yoke platform to rise to third layer.
After AGV trolley and yoke move synchronously in place, makes 3 outreach L of yoke by executing telescope motor, then execute
Lifting motor drives yoke platform falling head h, and cargo is put on shelf, and executing telescope motor later returns to zero yoke, i.e.,
A picking is completed to goods putting process.
In the process, the movement of yoke and the movement of AGV trolley are linked, save yoke individually go up and down execution when
Between, to improve the time for taking, putting goods.
Yoke elevating movement track is planned according to chassis traveling time, so that when lifting position arrival time and mobile chassis
Between it is consistent.
The foregoing is merely illustrative of the preferred embodiments of the present invention, is not intended to limit the invention, all in essence of the invention
Within mind and principle, any modification, equivalent replacement, improvement and so on be should all be included in the protection scope of the present invention.
Finally, it should be noted that the foregoing is only a preferred embodiment of the present invention, it is not intended to restrict the invention,
Although the present invention is described in detail referring to the foregoing embodiments, for those skilled in the art, still may be used
To modify the technical solutions described in the foregoing embodiments or equivalent replacement of some of the technical features.
All within the spirits and principles of the present invention, any modification, equivalent replacement, improvement and so on should be included in of the invention
Within protection scope.