WO2023036335A1 - Transport robot and method for retrieving and transporting box - Google Patents

Transport robot and method for retrieving and transporting box Download PDF

Info

Publication number
WO2023036335A1
WO2023036335A1 PCT/CN2022/118445 CN2022118445W WO2023036335A1 WO 2023036335 A1 WO2023036335 A1 WO 2023036335A1 CN 2022118445 W CN2022118445 W CN 2022118445W WO 2023036335 A1 WO2023036335 A1 WO 2023036335A1
Authority
WO
WIPO (PCT)
Prior art keywords
box
assembly
obstacle detection
detection module
handling robot
Prior art date
Application number
PCT/CN2022/118445
Other languages
French (fr)
Chinese (zh)
Inventor
王华培
Original Assignee
北京极智嘉科技股份有限公司
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
Priority claimed from CN202122211632.0U external-priority patent/CN216302260U/en
Priority claimed from CN202111071117.5A external-priority patent/CN115806136A/en
Application filed by 北京极智嘉科技股份有限公司 filed Critical 北京极智嘉科技股份有限公司
Publication of WO2023036335A1 publication Critical patent/WO2023036335A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G1/00Storing articles, individually or in orderly arrangement, in warehouses or magazines
    • B65G1/02Storage devices
    • B65G1/04Storage devices mechanical
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G1/00Storing articles, individually or in orderly arrangement, in warehouses or magazines
    • B65G1/02Storage devices
    • B65G1/04Storage devices mechanical
    • B65G1/137Storage devices mechanical with arrangements or automatic control means for selecting which articles are to be removed

Definitions

  • Handling robots play an important role in intelligent warehousing. Handling robots replace manual handling of goods. Before the current handling robot takes out the material box from the rack, it needs to pre-label the material box, such as QR code, radio frequency identification label, etc. , the handling robot judges the orientation of the material box by identifying the label attached to the material box. However, labeling the bins requires a lot of work, resulting in high production costs.
  • an object of the embodiments of the present application is to provide a handling robot and a method for picking and delivering boxes.
  • a handling robot including:
  • An obstacle detection module configured to detect whether the extension path of the telescopic fork mechanism is blocked;
  • the telescopic fork mechanism is configured to protrude when the obstacle detection module detects that the protruding path of the telescopic fork mechanism is unobstructed.
  • the retrieving and returning box assembly includes a box tray for carrying the box, and the first telescopic arm and the second telescopic arm are arranged on opposite sides of the box tray and configured to When the first obstacle detection module and the second obstacle detection module detect that the corresponding extension paths are not blocked, they extend relative to the bin tray.
  • each set of telescopic arms of the telescopic fork mechanism is a telescopic arm extended at one stage, or a telescopic arm extended at least two stages; the obstacle detection module is arranged on the telescopic fork mechanism The front end position of the end telescopic arm.
  • a control unit is further included, and the control unit sends a stop call in response to the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension paths are blocked. bin command, and report an exception; and,
  • the chassis assembly In response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to move a corresponding distance to the blocked side.
  • the chassis assembly in response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to the blocked side Move the corresponding distance within the predetermined movement threshold range.
  • control unit before the extension of the telescopic fork mechanism, responds to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked , control the chassis assembly to move a corresponding distance to the shaded side.
  • control unit responds to at least one electrical signal triggered when the first obstacle detection module and the second obstacle detection module detect in real time , control the telescopic fork mechanism to stop stretching out.
  • the obstacle detection module is a laser sensor or an infrared sensor.
  • it further includes a three-dimensional imaging module arranged on the retrieval box assembly, and the three-dimensional imaging module is configured to obtain three-dimensional position information of the material box.
  • the retrieval box assembly includes a material box tray for carrying material boxes, and a rear baffle located at the rear end of the material box tray; the three-dimensional imaging module is arranged at the center of the rear baffle Location.
  • a control unit is included, the control unit is configured to control the chassis assembly to move a corresponding distance within a predetermined movement threshold range based on the positional deviation from the bin obtained by the three-dimensional imaging module; and/or Or, control the bin tray to rotate at a corresponding angle within a predetermined rotation threshold range.
  • it further includes a two-dimensional imaging module arranged on the retrieving box assembly, and the two-dimensional imaging module is configured to obtain position information of marks on the material rack.
  • the retrieving box assembly includes a base and a material box tray arranged on the base; the two-dimensional imaging module is arranged at the center of the base, and is used to obtain the material shelf beam Location information for the identity of the central location.
  • a control unit is included, the control unit is configured to control the chassis assembly to move a corresponding distance within a predetermined movement threshold range based on the position deviation from the marker obtained by the two-dimensional imaging module; and/or Or control the lifting and lowering of the retrieving box assembly to a corresponding height.
  • a handling robot including:
  • the door frame assembly is connected to the chassis assembly;
  • the retrieval box assembly is configured to move up and down along the door frame assembly;
  • the retrieval box assembly includes a telescopic fork mechanism for extending or retracting;
  • a three-dimensional imaging module is arranged on the retrieving and returning box assembly, and the three-dimensional imaging module is configured to obtain three-dimensional position information of the material box.
  • the handling robot also includes:
  • a control unit configured to control the chassis assembly to move a corresponding distance within a predetermined movement threshold range based on the distance deviation between the retrieving box assembly and the material box obtained by the three-dimensional imaging module.
  • control unit is configured to drive the chassis assembly to move to The center of the retrieval box assembly is aligned with the center of the material box.
  • control unit is further configured to report an abnormality when the distance that the chassis component needs to move exceeds the predetermined movement threshold range.
  • control unit when configured as a retrieving box, it controls the lifting of the retrieving and returning box assembly so that the bearing surface of the retrieving and returning box assembly carrying the material box is lower than the material shelf a load-bearing surface for placing the container; and/or,
  • control unit When the control unit is configured as a feeding box, it controls the lifting of the take-and-return box assembly so that the bearing surface of the take-and-return box assembly for carrying the material box is higher than the bearing surface for placing the material box on the material rack.
  • the handling robot also includes:
  • control unit configured to control the retrieval box assembly to rotate by a corresponding angle within a predetermined rotation threshold range based on the angle deviation between the retrieval box assembly and the material box obtained by the 3D imaging module.
  • control unit is further configured to report an abnormality when the rotation angle of the return bin assembly exceeds the predetermined rotation threshold range.
  • the retrieval box assembly includes a material box tray for carrying material boxes, and a rear baffle located at the rear end of the material box tray; the three-dimensional imaging module is arranged at the center of the rear baffle Location.
  • the retrieval box assembly further includes a base and a rotation mechanism
  • the bin tray is mounted on the base through the rotation mechanism
  • the control unit is configured to control The rotating mechanism drives the bin tray to rotate relative to the base.
  • the three-dimensional imaging module includes a depth camera or a panoramic camera.
  • the handling robot further includes an obstacle detection module
  • the telescopic fork mechanism includes a pair of first and second telescopic arms arranged in parallel; the obstacle detection module is set There are at least two, respectively the first obstacle detection module set at the front end of the first telescopic arm, and the second obstacle detection module at the front end of the second telescopic arm.
  • the retrieving and returning box assembly includes a box tray for carrying the box, and the first telescopic arm and the second telescopic arm are arranged on opposite sides of the box tray and configured to When the first obstacle detection module and the second obstacle detection module detect that the corresponding extension paths are not blocked, they extend relative to the bin tray.
  • each set of telescopic arms of the telescopic fork mechanism is a telescopic arm extended at one stage, or a telescopic arm extended at least two stages; the obstacle detection module is arranged on the telescopic fork mechanism The front end position of the end telescopic arm.
  • a control unit is further included, and the control unit sends a stop call in response to the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension paths are blocked. bin command, and report an exception; and,
  • the chassis assembly In response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to move a corresponding distance to the blocked side.
  • a method for picking up and delivering boxes which is applied to the above-mentioned handling robot, including a box picking step and a box sending step, and the box picking step and box returning step both include the following steps:
  • Step S1000 controlling the take-and-return box assembly to be lifted to the target height
  • Step S2000 controlling the obstacle detection module to detect whether the extension path of the telescopic fork mechanism is blocked
  • Step S3000 in response to the obstacle detection module detecting that the extending path is not blocked, controlling the telescopic fork mechanism to extend.
  • the telescopic fork mechanism includes a first telescopic arm and a second telescopic arm
  • the obstacle detection module includes a first obstacle for detecting whether the extending path of the first telescopic arm is blocked An object detection module, and a second obstacle detection module for detecting whether the extending path of the second telescopic arm is blocked;
  • the step S2000 includes:
  • Step S2100 controlling the first obstacle detection module and the second obstacle detection module to detect whether the extending paths of the first telescopic arm and the second telescopic arm are blocked;
  • Step S2200 in response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, control the handling robot to move to the blocked side until the side is cleared. is obscured;
  • Step S2300 when the first obstacle detection module and the second obstacle detection module detect that the corresponding extension paths are blocked, issue a command to stop the retrieving box and report an exception.
  • the obstacle detection module detects in real time whether the extension path of the telescopic fork mechanism is blocked, and when the obstacle detection module When the group detects that the extending path is blocked, it controls the telescopic fork mechanism to stop extending.
  • step S1000 further includes:
  • the two-dimensional imaging module detects the positional deviation from the mark on the beam of the corresponding material rack, and based on the positional deviation, controls the chassis assembly to move a corresponding distance within a predetermined movement threshold; and/or controls the lifting and lowering of the return box assembly to a corresponding height .
  • when retrieving the material box when retrieving the material box, drive the retrieving and returning box assembly to lift to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack; when feeding the material box, drive the The take-and-return box assembly is lifted to make the load-bearing surface of the material box tray higher than the load-bearing surface for placing the material box on the material rack.
  • step S1000 further includes:
  • the three-dimensional imaging module detects the position deviation of the bin on the corresponding rack, and based on the position deviation controls the handling robot to move a corresponding distance within the predetermined movement threshold range; and/or controls the bin tray to rotate within the predetermined rotation threshold range corresponding angle.
  • a method for retrieving and returning a box including a step of taking a box and a step of sending a box, applied to a handling robot, the handling robot includes a chassis assembly, a door frame assembly, and a box retrieving assembly, the The gantry assembly is connected to the chassis assembly; the retrieving box assembly is configured to move up and down along the gantry assembly, and the retrieving box assembly includes a bin tray for carrying the bins; it also includes a two-dimensional imaging module, including the following steps:
  • the box sending step based on the position of the target box location mark obtained by the two-dimensional imaging module, the horizontal position deviation between the return box assembly and the mark is obtained; based on the obtained Said horizontal position deviation, control the movement of the chassis assembly to adjust the horizontal displacement of the retrieval box assembly.
  • the step of taking out the box it also includes:
  • a method for removing boxes comprising the following steps:
  • Step S1 the handling robot walks to the target position, and controls the take-and-return box assembly to lift to the target height;
  • Step S2 Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly based on the obtained position deviation of the retrieval box assembly;
  • Step S3 through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm and the second telescopic arm are blocked,
  • step S4 If one side is blocked, control the extension path of the chassis assembly to move from the blocked side to both sides without being blocked, and then proceed to step S4;
  • step S4 If there is no occlusion on both sides, proceed to step S4;
  • Step S4 Obtain the three-dimensional information of the material box based on the three-dimensional imaging module, and obtain the positional deviation between the retrieving and returning box assembly and the material box;
  • step S5 If the positional deviation between the retrieving and returning box assembly and the material box is outside the allowable range, control the chassis assembly to move a corresponding distance within a predetermined movement threshold; and/or control the material box tray to rotate within a predetermined rotation threshold Angle; then execute step S5;
  • Step S5 controlling the extension of the retrieval box assembly.
  • step S2 the height of the retrieval bin assembly is adjusted based on the height position deviation of the retrieval bin assembly.
  • a box delivery method comprising the following steps:
  • Step S1 the handling robot walks to the target position, and controls the take-and-return box assembly to lift to the target height;
  • Step S2 Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly based on the obtained position deviation;
  • Step S3 through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm and the second telescopic arm are blocked,
  • step S4 If at least one side is blocked, stop delivering boxes and report an abnormality; if both sides are not blocked, proceed to step S4;
  • Step S4 controlling the extension of the retrieval box assembly.
  • step S2 in step S2:
  • the horizontal displacement of the retrieval bin assembly is adjusted based on the horizontal deviation of the retrieval bin assembly.
  • An advantageous effect of the present application is that the handling robot can detect whether the extension path of the telescopic fork mechanism is blocked through the obstacle detection module. Only when it is not blocked, will the telescopic fork mechanism be controlled to extend, remove the material box from the material rack, or push the material box to the material rack for storage. This ensures that the telescopic fork mechanism will not collide with the material box, and ensures that there will be no interference with other material boxes when returning the box, ensuring the regularity of the arrangement of the material box on the material rack, which greatly improves the efficiency of the box retrieval process. Automation, accuracy and security.
  • Fig. 1 is a schematic diagram of the overall structure of a handling robot provided by an embodiment of the present application
  • Fig. 2 is a structural schematic diagram of a handling robot retrieving and returning box assembly provided by an embodiment of the present application
  • Fig. 3 is a schematic diagram of another structure of the retrieving and returning box assembly of the handling robot provided by an embodiment of the present application;
  • Fig. 4 is a schematic structural view of the bottom of the retrieving and returning box assembly of the handling robot provided by an embodiment of the present application;
  • Chassis assembly 100.
  • Mast assembly 300.
  • Retrieval box assembly 310.
  • First telescopic arm 320.
  • Second telescopic arm 330.
  • Material box tray 340.
  • Front gear 350.
  • Rear gear 360.
  • Base 370.
  • Rotation mechanism 410.
  • First obstacle detection module 420.
  • Second obstacle detection module 500.
  • Three-dimensional imaging module 600. Two-dimensional imaging module.
  • the present application provides a handling robot, as shown in FIGS. 1 to 4 , including a chassis assembly 100 , a door frame assembly 200 , a retrieving and returning box assembly 300 and an obstacle detection module.
  • the chassis assembly 100 can walk on the ground, and the mast assembly 200 is erected and connected to the chassis assembly 100 .
  • the retrieval box assembly 300 is connected to the door frame assembly 200 and is configured to move up and down along the door frame assembly 200.
  • the retrieval box assembly 300 also includes a telescopic fork mechanism that can extend or retract in the horizontal direction. And tick or push the material box.
  • the obstacle detection module is configured to detect whether the extension path of the telescopic fork mechanism is blocked, and the telescopic fork mechanism is configured to extend when the obstacle detection module detects that the extension path of the telescopic fork mechanism is not blocked.
  • the handling robot can detect whether the extension path of the telescopic fork mechanism is blocked through the obstacle detection module to judge the relative position of the telescopic fork mechanism and the material box.
  • the obstacle detection module can identify them to prevent the telescopic fork mechanism from colliding with the material box or Collision with other obstacles.
  • the retrieval box assembly Only when the obstacle detection module detects that the extension path of the telescopic fork mechanism is not blocked, the retrieval box assembly is allowed to extend, so as to hook the material box on the material rack to the handling robot, or to move the handling robot The upper material box is pushed to the material rack for storage. This can prevent the telescopic fork mechanism from colliding with the material box during the stretching process, causing serious misalignment of the material box or other adjacent material boxes, thereby ensuring the safety of the box removal process.
  • the telescopic fork mechanism of the retrieving and returning box assembly 300 includes a pair of first telescopic arms 310 and second telescopic arms 320 arranged in parallel, during the process of retrieving and returning the box, the first telescopic arms 310 and the second telescopic arms 320 are driven by the same drive unit , allowing it to reach out to opposite sides of the bin simultaneously.
  • the detection direction of the first obstacle detection module 410 is the extension direction of the first telescopic arm 310
  • the detection direction of the second obstacle detection module 420 is the extension direction of the second telescopic arm 320 .
  • the obstacle detection module can be a photoelectric sensor such as a laser sensor or an infrared sensor, which can detect whether there is an obstacle in front within the set detection depth range.
  • a laser sensor can emit a laser beam in the detection direction. When there is an obstacle in front, the emitted laser beam will hit the obstacle. At this time, it can be detected by the laser sensor. At this time, it can also be understood as a laser sensor or an infrared sensor. To be triggered, to emit a triggered electrical signal.
  • the first telescopic arm 310 and the second telescopic arm 320 act simultaneously.
  • the first telescopic arm 310 and the second telescopic arm 310 Neither arm 320 is extended.
  • the obstacle detection module is also configured to be able to perform real-time detection during the extension of the telescopic fork mechanism. If during the extension process of the telescopic fork mechanism, due to various factors, the material box is offset or other reasons, as long as there is an obstacle on the extension path of the telescopic fork mechanism, the obstacle detection module can be triggered immediately, and the telescopic fork The mechanism stops the extension motion so as not to hit the obstacle. During this process, the first telescopic arm 310 and the second telescopic arm 320 keep moving synchronously. When any one of the first obstacle detection module 410 and the second obstacle detection module 420 is triggered, the first telescopic arm 310 and the second The two telescopic arms 320 stop extending simultaneously.
  • the retrieving and returning box assembly 300 includes a box tray 330 for carrying the box, the first telescopic arm 310 and the second telescopic arm 320 are arranged on opposite sides of the box tray 330, and are configured to be used when the first obstacle detection module When the group 410 and the second obstacle detection module 420 are not triggered, they protrude relative to the bin tray 330 .
  • the telescopic arms of the second stage and the telescopic arms of the third stage are stretched out sequentially or simultaneously, thereby the extension length of the telescopic arms can be increased.
  • the telescopic arm adopts several stages of telescopic expansion and can be adjusted according to different situations. For example, when the length of each telescopic arm changes, the corresponding telescopic level can also be adjusted accordingly. When the length of each telescopic arm becomes shorter, three levels can be used.
  • the telescopic arm takes the goods picked up by the secondary telescopic arm (the telescopic arm is longer).
  • Each group of telescopic arms of telescopic fork mechanism can be adjusted according to different application scenarios.
  • the telescopic fork mechanism usually adopts a two-stage telescopic arm structure, that is, the two-stage telescopic arms are combined together.
  • the two-stage telescopic arms are sequentially or Simultaneously unfold.
  • the obstacle detection module is arranged at the front end of the telescopic arm at the end of the telescopic fork mechanism, and the two front shifting teeth 340 are also respectively arranged at the front end of the telescopic arm at the two ends of the telescopic fork mechanism. This can prevent the detection path of the obstacle detection module from being blocked by some mechanism of the telescopic arm itself.
  • a telescopic arm structure with one-stage extension or a telescopic arm structure with two-stage extension can be used.
  • two-stage telescopic arms only one stage of telescopic arms can be controlled to stretch out to complete retrieving and returning boxes at a single deep position.
  • the retrieval box assembly 300 is provided with a telescopic drive unit, which is used to drive the telescopic fork mechanism to extend or retract, and to drive the two front shifting teeth 340 to move.
  • the telescopic drive unit can use a rotary motor, a linear motor, a gear set, etc., and cooperate with a corresponding transmission mechanism to realize the movement of the telescopic fork mechanism, which can be realized by those skilled in the art based on the prior art.
  • the handling robot includes a control unit, which can receive the detection signal of the obstacle detection module, and the chassis assembly 100 and the retrieving box assembly 300 are all controlled by the control unit.
  • the control unit can control the chassis assembly 100 to walk to the target position on the ground based on the command to take out the box or the command to return the box, and control the box assembly 300 to move to the height where the box needs to be picked up and returned, and then control the box assembly 300 to take away or Return box.
  • the three-dimensional imaging module 500 can be a depth camera or a panoramic camera, or a combination of multiple cameras, as long as it can obtain the three-dimensional imaging information of the material box.
  • the 3D imaging module 500 can send the acquired 3D position information to the control unit.
  • step S2000, and steps S2100, S2200, and S2300 are performed before the first telescopic arm and the second telescopic arm of the telescopic fork mechanism are not stretched out.
  • the telescopic fork mechanism controls the first obstacle detection module 410 and the second obstacle detection module 420 to detect in real time during the extension process. If it is blocked, the telescopic fork mechanism is controlled to stop extending forward, and an abnormality is reported.
  • the robot can give up the step of picking up and delivering boxes, and wait for the system to assign other tasks.
  • the height position deviation and the horizontal position deviation between the retrieval box assembly and the sign can be simultaneously obtained based on the sign position acquired by the two-dimensional imaging module. It is also possible to first obtain the height position deviation and adjust the height position of the return box assembly, then identify the marking position again, and adjust the horizontal position of the return box assembly based on the recognized horizontal position deviation, and vice versa, which is not done here Be specific.
  • the three-dimensional information of the bins at the target bin location is obtained through the three-dimensional imaging module, and the relative angular deviation and/or horizontal position deviation between the retrieving bin assembly and the bins is obtained based on the three-dimensional information of the bins.
  • the business system sends an order to the handling robot to pick up the material box.
  • the handling robot After the handling robot receives the business order, it moves to the target (X, Y) position based on its navigation system, and according to the position information of the material box contained in the business order, it will pick up and return The box assembly is lifted to the target height h.
  • These coordinate information are pre-stored in the business system or in the handling robot, and the handling robot can make corresponding operations based on the position information.
  • Step S3 through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm 310 and the second telescopic arm 320 are blocked,
  • step S4 in this step, set the maximum adjustment threshold, so as to avoid Bump into adjacent cargo boxes or shelf columns;
  • step S4 If there is no occlusion on both sides, proceed to step S4;
  • Step S4 based on the three-dimensional imaging module 500, obtain the three-dimensional information of the material box, and obtain the positional deviation between the retrieving and returning box assembly 300 and the material box;
  • the material box tray is driven to rotate to make it consistent with the material box.
  • the lateral or horizontal offset between the retrieval box assembly and the material box identified by the three-dimensional imaging module 500 drives the chassis assembly to move to align the center of the retrieval box assembly with the center of the material box.
  • step S5 can be directly performed. If the deviation between the retrieving bin assembly 300 and the material bin is outside the allowable range, it should be determined that the position of the retrieving bin assembly 300 needs to be adjusted at this time.
  • step S5 is directly performed after adjusting the telescopic arms on both sides of the retrieval box assembly 300 to be parallel to the side walls of the material box. If the deviation between the retrieval box assembly 300 and the material box is outside the allowable range, adjust the telescopic arms on both sides of the retrieval box assembly 300 to be parallel to the side walls of the material box, and then perform step S4 to check.
  • Step S5 controlling the retrieval box assembly 300 to extend out.
  • the present application also provides a box picking method in the following embodiments, which is applied to a handling robot, which includes the following steps:
  • Step S100 controlling the take-and-return box assembly to be lifted to the target height
  • step S200 the three-dimensional information of the material box is obtained based on the three-dimensional imaging module, and the positional deviation between the retrieving and returning box assembly and the material box is obtained.
  • the 3D imaging module After the 3D imaging module obtains the 3D position of the material box in front of it, it can obtain the 3D deviation between the material box and the 3D imaging module or the retrieval box assembly, which includes displacement deviation and angle deviation. For example, the distance information of several points on the front side of the material box can be calculated, and the deflection angle of the material box can be judged according to the distance information. For another example, after the depth camera obtains the image of the material box, it can analyze the deviation between the center of the material box and the center of the return box assembly, and use it as the distance of the level and height of the material box. The technology of obtaining the image of the material box through the depth camera and judging the position deviation of the material box belongs to the common knowledge of those skilled in the art, and will not be described in detail here.
  • Step S300 controlling the chassis assembly to move a corresponding distance; and/or controlling the bin tray to rotate a corresponding angle.
  • the control unit controls the lifting of the retrieving bin assembly to a proper position based on the obtained height deviation between the material bin and the retrieving bin assembly. Since the 3D imaging module obtains the 3D position information of the material box, it can obtain the height offset distance between it and the material box. Based on the height offset, the control unit can drive the retrieving box assembly to move the corresponding distance to eliminate the deviation in the height direction between the retrieval box assembly and the material box.
  • the take-and-return box assembly can be controlled to lift to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack, so that the material box can be lifted from a higher target box position. Moves smoothly onto the lower bin pallet.
  • the corresponding adjustment function based on horizontal offset, height offset, and angle offset can be arbitrary, such as only adjusting based on horizontal offset, or only adjusting based on height offset , or only realize the adjustment based on the angle offset; it can also be any combination, such as adjusting the horizontal position and the angle position based on the horizontal offset and the angle offset, or others, which will not be described in detail here.
  • the offset of the adjustment displacement of the chassis component can be controlled first, and the angle offset of the adjustment of the material box tray can also be controlled first, which is not limited here.
  • the center of the retrieving and returning box assembly can be aligned with the center of the material box. Compared with the traditional method, labeling on the material box can be avoided, the alignment accuracy is improved, and the cost is reduced.
  • the handling robot may include a chassis component, a door frame component, a retrieval box component, and a three-dimensional imaging module.
  • a two-dimensional imaging module can be set on the return box component, and the two-dimensional imaging module can identify the identification code on the shelf layer, obtain the position of the target box position identification, and obtain the return box
  • the horizontal position deviation between the component and the logo based on the horizontal position deviation obtained, the movement of the chassis component is controlled to adjust the horizontal displacement of the take-and-return box component, and then the three-dimensional imaging module is combined to align the take-and-return box component with the material box Make unboxing.
  • the steps of cooperating between the 2D imaging module and the 3D imaging module may be the same as those in other embodiments above, and will not be described in detail here. It can also be the above-mentioned handling robot including the obstacle detection module. Therefore, in this embodiment, it can also be adapted to the above-mentioned steps related to the obstacle detection module, which will not be described in detail here.
  • the method disclosed above is also applicable to the step of putting boxes.
  • the module adjusts the horizontal offset and/or height offset and/or angular offset of the retrieving and returning box assembly relative to the target box position on the rack. It should be noted that when adjusting the height offset, the take-and-return box assembly can be driven up and down to make the bearing surface of the material box tray higher than the bearing surface for placing the material box on the material rack, so that the material box can be placed from a higher The material box pallet moves smoothly to the lower target box position.
  • the present application provides a box delivery method in the following embodiments, including the following steps:
  • Step S1 the transport robot walks to the target position, and controls the take-and-return box assembly 300 to lift to the target height;
  • the business system sends an instruction to the handling robot to send the material box.
  • the handling robot moves to the target (X, Y) position based on its navigation system, and returns the box according to the position information of the material box included in the business order.
  • the component is lifted to the target height h.
  • Step S2 Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly 300 based on the obtained position deviation;
  • the two-dimensional imaging module is used to adjust the height of the take-and-return box assembly 300 based on the height position deviation of the take-and-return box assembly 300, and to accurately position the take-and-return box assembly 300 to compensate for the unevenness of the ground.
  • the position of the retrieving and returning box assembly is adjusted so that the bearing surface of the material box tray 330 is higher than the bearing surface for placing material boxes on the material shelf.
  • the chassis assembly can be controlled to move so that the center of the return box assembly is aligned with the center of the mark on the beam.
  • step S4 If there is no occlusion on both sides, proceed to step S4;
  • Step S4 controlling the extension of the retrieval box assembly 300 .
  • the box retrieval and return assembly 300 can be controlled to perform box return action. If it is detected that at least one of the front extension paths of the first telescopic arm 310 and the second telescopic arm 320 is blocked, it may be that other material boxes occupy part of the target material box positions. If the handling robot adjusts its position, the material box released by it may deviate from the target material box position, or even occupy other material box positions, resulting in the failure of the next material box position to return the box smoothly, resulting in a chain of material box offsets. Therefore, if one side is blocked during the box return process, the box return will stop and an exception will be reported. The robot can also give up this task and wait for the system to assign other tasks, such as informing the robot to return the box to another box location.
  • the action is stopped and an abnormality is reported to the business system.
  • the business system After the business system receives the corresponding exception, it can assign different tasks to the robot according to the type of exception.
  • the robot may give up the task of picking up and delivering the box.
  • the system receives the abnormal signal, it can assign the robot to pick up and deliver the boxes in other boxes, and notify the manual to deal with the abnormal boxes.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Warehouses Or Storage Devices (AREA)

Abstract

A transport robot and a method for retrieving and transporting a box. The transport robot comprises a chassis assembly (100); a gantry assembly (200), the gantry assembly being connected to the chassis assembly; a box retrieval and return assembly (300), the box retrieval and return assembly being constructed to move up and down along the gantry assembly, and the box retrieval and return assembly comprising a telescopic fork mechanism that extends or retracts; and obstacle detection modules (410, 420), the obstacle detection modules being configured to detect whether the extension path of the telescopic fork mechanism is blocked; the telescopic fork mechanism is configured to extend out when the obstacle detection modules detect that the extension path of the telescopic fork mechanism is not blocked. The described transport robot improves the automation, accuracy and safety of the process of box retrieval and return.

Description

一种搬运机器人及取送箱方法A handling robot and method for picking and delivering boxes
本申请要求于2021年09月13日提交中国专利局、申请号为202111071117.5、发明名称为“一种搬运机器人及取送箱方法”、2021年09月13日提交中国专利局、申请号为202122211632.0、发明名称为“一种搬运机器人”、2021年09月13日提交中国专利局、申请号为202220680318.9、发明名称为“搬运机器人”的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application is required to be submitted to the China Patent Office on September 13, 2021, the application number is 202111071117.5, the title of the invention is "a handling robot and a method for picking up and delivering boxes", and it is submitted to the China Patent Office on September 13, 2021, and the application number is 202122211632.0 , the title of the invention is "a handling robot", submitted to the China Patent Office on September 13, 2021, the application number is 202220680318.9, and the priority of the Chinese patent application titled "handling robot", the entire content of which is incorporated herein by reference Applying.
技术领域technical field
本申请涉及仓储物流领域,特别涉及一种搬运机器人;本申请还涉及一种取送箱方法。The present application relates to the field of warehousing and logistics, in particular to a handling robot; the present application also relates to a method for picking and delivering boxes.
背景技术Background technique
智能仓储是物流的发展趋势,智能仓储的应用,需要保证货物仓库管理各个环节数据输入的速度和准确性,确保企业及时准确地掌握库存的真是数据,合理保持和控制企业库存。通过科学的编码,还可方便地对库存货物的批次、保质期等进行管理。利用SNHGES系统的库位管理功能,更可以及时掌握所有库存货物当前所在位置,有利于提高仓库管理的工作效率。Intelligent warehousing is the development trend of logistics. The application of intelligent warehousing needs to ensure the speed and accuracy of data input in all aspects of cargo warehouse management, ensure that enterprises can grasp the real data of inventory in a timely and accurate manner, and maintain and control enterprise inventory reasonably. Through scientific coding, it is also convenient to manage the batches and shelf life of inventory goods. Utilizing the location management function of the SNHGES system, it is possible to grasp the current location of all inventory goods in a timely manner, which is conducive to improving the efficiency of warehouse management.
搬运机器人在智能仓储中扮演着重要的角色,搬运机器人代替人工搬运货物,目前的搬运机器人在从料架取出料箱前,需要预先对料箱贴设标签,如二维码,射频识别标签等,搬运机器人通过识别料箱上贴设的标签判断料箱的方位。但是,对料箱贴设标签的作业量极大,导致生产成本过高。Handling robots play an important role in intelligent warehousing. Handling robots replace manual handling of goods. Before the current handling robot takes out the material box from the rack, it needs to pre-label the material box, such as QR code, radio frequency identification label, etc. , the handling robot judges the orientation of the material box by identifying the label attached to the material box. However, labeling the bins requires a lot of work, resulting in high production costs.
另外,由于料架安装精度、巷道地面的不平整,以及料箱在放置时的偏移,仅靠预置在系统里的操作指令,很难保证在取箱过程中取还箱组件不会与料箱发生碰撞,造成危险。因此,亟需一种解决该问题的方案。In addition, due to the installation accuracy of the material rack, the unevenness of the roadway ground, and the offset of the material box when it is placed, it is difficult to ensure that the box components will not be separated from each other during the box picking process only by operating instructions preset in the system. The bins collide, creating a hazard. Therefore, need badly a kind of scheme that solves this problem.
发明内容Contents of the invention
为了解决现有技术中存在的问题,本申请实施例的一个目的是提供了一种搬运机器人及取送箱方法。In order to solve the problems existing in the prior art, an object of the embodiments of the present application is to provide a handling robot and a method for picking and delivering boxes.
根据本申请的第一方面,提供了一种搬运机器人,包括:According to the first aspect of the present application, a handling robot is provided, including:
底盘组件;Chassis components;
门架组件,所述门架组件连接在所述底盘组件上;a door frame assembly, the door frame assembly is connected to the chassis assembly;
取还箱组件,所述取还箱组件被构造为沿着所述门架组件上下移动;所述取还箱组件包括用于伸出或缩回的伸缩叉机构;a retrieval box assembly, the retrieval box assembly is configured to move up and down along the door frame assembly; the retrieval box assembly includes a telescopic fork mechanism for extending or retracting;
障碍物检测模组,所述障碍物检测模组被配置为用于探测伸缩叉机构的伸出路径是否被遮挡;An obstacle detection module, the obstacle detection module is configured to detect whether the extension path of the telescopic fork mechanism is blocked;
所述伸缩叉机构被配置为:当障碍物检测模组探测伸缩叉机构的伸出路径无遮挡时伸出。The telescopic fork mechanism is configured to protrude when the obstacle detection module detects that the protruding path of the telescopic fork mechanism is unobstructed.
在本公开的一个实施例中,所述伸缩叉机构包括一对平行布置的第一伸缩臂、第二伸缩臂;所述障碍物检测模组设置有至少两个,分别为设置在第一伸缩臂前端位置的第一障碍物检测模组,以及位于第二伸缩臂前端位置的第二障碍物检测模组。In one embodiment of the present disclosure, the telescopic fork mechanism includes a pair of first telescopic arm and a second telescopic arm arranged in parallel; the obstacle detection module is provided with at least two, respectively arranged on the first telescopic The first obstacle detection module at the front end of the arm, and the second obstacle detection module at the front end of the second telescopic arm.
在本公开的一个实施例中,所述取还箱组件包括用于承载料箱的料箱托盘,所述第一伸缩臂、第二伸缩臂设置在料箱托盘相对的两侧,且被配置为当第一障碍物检测模组、第二障碍物检测模组检测相应的伸出路径未被遮挡时,相对于所述料箱托盘伸出。In one embodiment of the present disclosure, the retrieving and returning box assembly includes a box tray for carrying the box, and the first telescopic arm and the second telescopic arm are arranged on opposite sides of the box tray and configured to When the first obstacle detection module and the second obstacle detection module detect that the corresponding extension paths are not blocked, they extend relative to the bin tray.
在本公开的一个实施例中,所述伸缩叉机构每组伸缩臂为一级伸出的伸缩臂,或者为至少两级伸出的伸缩臂;所述障碍物检测模组设置在伸缩叉机构末端伸缩臂的前端位置。In an embodiment of the present disclosure, each set of telescopic arms of the telescopic fork mechanism is a telescopic arm extended at one stage, or a telescopic arm extended at least two stages; the obstacle detection module is arranged on the telescopic fork mechanism The front end position of the end telescopic arm.
在本公开的一个实施例中,还包括控制单元,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组检测到相应的伸出路径均被遮挡时,发出停止取料箱指令,并上报异常;以及,In one embodiment of the present disclosure, a control unit is further included, and the control unit sends a stop call in response to the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension paths are blocked. bin command, and report an exception; and,
响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧移动相应的距离。In response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to move a corresponding distance to the blocked side.
在本公开的一个实施例中,响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧在预定移动阈值范围内移动相应的距离。In one embodiment of the present disclosure, in response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to the blocked side Move the corresponding distance within the predetermined movement threshold range.
在本公开的一个实施例中,在伸缩叉机构伸出之前,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧移动相应的距离。In an embodiment of the present disclosure, before the extension of the telescopic fork mechanism, the control unit responds to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked , control the chassis assembly to move a corresponding distance to the shaded side.
在本公开的一个实施例中,在伸缩叉机构伸出的过程中,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组实时检测时被触发的至少一个电信号时,控制伸缩叉机构停止伸出。In one embodiment of the present disclosure, during the extension process of the telescopic fork mechanism, the control unit responds to at least one electrical signal triggered when the first obstacle detection module and the second obstacle detection module detect in real time , control the telescopic fork mechanism to stop stretching out.
在本公开的一个实施例中,所述障碍物检测模组为激光传感器或红外传感器。In one embodiment of the present disclosure, the obstacle detection module is a laser sensor or an infrared sensor.
在本公开的一个实施例中,还包括设置在取还箱组件上的三维成像模组,所述三维成像模组被配置为用于获取料箱的三维位置信息。In one embodiment of the present disclosure, it further includes a three-dimensional imaging module arranged on the retrieval box assembly, and the three-dimensional imaging module is configured to obtain three-dimensional position information of the material box.
在本公开的一个实施例中,所述取还箱组件包括用于承载料箱的料箱托盘,及位于料箱托盘后端的后挡板;所述三维成像模组设置在后挡板的中心位置。In one embodiment of the present disclosure, the retrieval box assembly includes a material box tray for carrying material boxes, and a rear baffle located at the rear end of the material box tray; the three-dimensional imaging module is arranged at the center of the rear baffle Location.
在本公开的一个实施例中,包括控制单元,所述控制单元被配置为基于三维成像模组获得的与料箱的位置偏差,控制底盘组件在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度。In one embodiment of the present disclosure, a control unit is included, the control unit is configured to control the chassis assembly to move a corresponding distance within a predetermined movement threshold range based on the positional deviation from the bin obtained by the three-dimensional imaging module; and/or Or, control the bin tray to rotate at a corresponding angle within a predetermined rotation threshold range.
在本公开的一个实施例中,所述三维成像模组包括深度相机。In one embodiment of the present disclosure, the three-dimensional imaging module includes a depth camera.
在本公开的一个实施例中,还包括设置在取还箱组件上的二维成像模组,所述二维成像模组被配置为用于获取料架上标识的位置信息。In one embodiment of the present disclosure, it further includes a two-dimensional imaging module arranged on the retrieving box assembly, and the two-dimensional imaging module is configured to obtain position information of marks on the material rack.
在本公开的一个实施例中,所述取还箱组件包括基座以及设置在基座上的料箱托盘;所述二维成像模组设置在基座的中心位置,用于获取料架横梁中心位置的标识的位置信息。In one embodiment of the present disclosure, the retrieving box assembly includes a base and a material box tray arranged on the base; the two-dimensional imaging module is arranged at the center of the base, and is used to obtain the material shelf beam Location information for the identity of the central location.
在本公开的一个实施例中,包括控制单元,所述控制单元被配置为基于二维成像模组获得的与标识的位置偏差,控制底盘组件在预定移动阈值范围内移动相应的距离;和/或控制取还箱组件升降相应的高度。In one embodiment of the present disclosure, a control unit is included, the control unit is configured to control the chassis assembly to move a corresponding distance within a predetermined movement threshold range based on the position deviation from the marker obtained by the two-dimensional imaging module; and/or Or control the lifting and lowering of the retrieving box assembly to a corresponding height.
在本公开的一个实施例中,取料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面;送料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面。In one embodiment of the present disclosure, when retrieving the material box, drive the retrieving and returning box assembly to lift to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack; when feeding the material box, drive the The take-and-return box assembly is lifted to make the load-bearing surface of the material box tray higher than the load-bearing surface for placing the material box on the material rack.
根据本申请的第二方面,提供了一种搬运机器人,包括:According to a second aspect of the present application, a handling robot is provided, including:
底盘组件;Chassis components;
门架组件,所述门架组件连接在所述底盘组件上;a door frame assembly, the door frame assembly is connected to the chassis assembly;
取还箱组件,所述取还箱组件被构造为沿着所述门架组件上下移动;所述取还箱组件包括用于伸出或缩回的伸缩叉机构;a retrieval box assembly, the retrieval box assembly is configured to move up and down along the door frame assembly; the retrieval box assembly includes a telescopic fork mechanism for extending or retracting;
三维成像模组,设置在所述取还箱组件上,且所述三维成像模组被配置为用于获取料箱的三维位置信息。A three-dimensional imaging module is arranged on the retrieving and returning box assembly, and the three-dimensional imaging module is configured to obtain three-dimensional position information of the material box.
在本公开的一个实施例中,所述搬运机器人还包括:In one embodiment of the present disclosure, the handling robot also includes:
控制单元,所述控制单元被配置为基于所述三维成像模组获得的所述取还箱组件与料箱的距离偏差,控制所述底盘组件在预定移动阈值范围内移动相应的距离。A control unit configured to control the chassis assembly to move a corresponding distance within a predetermined movement threshold range based on the distance deviation between the retrieving box assembly and the material box obtained by the three-dimensional imaging module.
在本公开的一个实施例中,所述控制单元被配置为基于所述三维成像模组识别到的所述取还箱组件与料箱的横向或水平偏移,驱动所述底盘组件运动至使所述取还箱组件的中心和料箱的中心对齐。In one embodiment of the present disclosure, the control unit is configured to drive the chassis assembly to move to The center of the retrieval box assembly is aligned with the center of the material box.
在本公开的一个实施例中,所述控制单元还被配置为当所述底盘组件需要移动的距离超出所述预定移动阈值范围时,上报异常。In an embodiment of the present disclosure, the control unit is further configured to report an abnormality when the distance that the chassis component needs to move exceeds the predetermined movement threshold range.
在本公开的一个实施例中,所述控制单元还被配置为取料箱时,控制所述取还箱组件 升降至使所述取还箱组件上承载料箱的承载面低于料架上用于放置料箱的承载面;和/或,In an embodiment of the present disclosure, when the control unit is configured as a retrieving box, it controls the lifting of the retrieving and returning box assembly so that the bearing surface of the retrieving and returning box assembly carrying the material box is lower than the material shelf a load-bearing surface for placing the container; and/or,
所述控制单元还被配置为送料箱时,控制所述取还箱组件升降至使所述取还箱组件上承载料箱的承载面高于料架上用于放置料箱的承载面。When the control unit is configured as a feeding box, it controls the lifting of the take-and-return box assembly so that the bearing surface of the take-and-return box assembly for carrying the material box is higher than the bearing surface for placing the material box on the material rack.
在本公开的一个实施例中,所述搬运机器人还包括:In one embodiment of the present disclosure, the handling robot also includes:
控制单元,所述控制单元被配置为基于所述三维成像模组获得的所述取还箱组件与料箱的角度偏差,控制所述取还箱组件在预定转动阈值范围内转动相应的角度。A control unit, the control unit is configured to control the retrieval box assembly to rotate by a corresponding angle within a predetermined rotation threshold range based on the angle deviation between the retrieval box assembly and the material box obtained by the 3D imaging module.
在本公开的一个实施例中,所述控制单元还被配置为当所述取还箱组件需要转动的角度超出所述预定转动阈值范围时,上报异常。In an embodiment of the present disclosure, the control unit is further configured to report an abnormality when the rotation angle of the return bin assembly exceeds the predetermined rotation threshold range.
在本公开的一个实施例中,所述取还箱组件包括用于承载料箱的料箱托盘,及位于料箱托盘后端的后挡板;所述三维成像模组设置在后挡板的中心位置。In one embodiment of the present disclosure, the retrieval box assembly includes a material box tray for carrying material boxes, and a rear baffle located at the rear end of the material box tray; the three-dimensional imaging module is arranged at the center of the rear baffle Location.
在本公开的一个实施例中,所述取还箱组件还包括基座和旋转机构,所述料箱托盘通过所述旋转机构安装在所述基座上,所述控制单元被配置为通过控制所述旋转机构驱动所述料箱托盘相对于所述基座转动。In one embodiment of the present disclosure, the retrieval box assembly further includes a base and a rotation mechanism, the bin tray is mounted on the base through the rotation mechanism, and the control unit is configured to control The rotating mechanism drives the bin tray to rotate relative to the base.
在本公开的一个实施例中,所述三维成像模组包括深度相机或全景相机。In an embodiment of the present disclosure, the three-dimensional imaging module includes a depth camera or a panoramic camera.
在本公开的一个实施例中,所述搬运机器人还包括障碍物检测模组,所述伸缩叉机构包括一对平行布置的第一伸缩臂、第二伸缩臂;所述障碍物检测模组设置有至少两个,分别为设置在第一伸缩臂前端位置的第一障碍物检测模组,以及位于第二伸缩臂前端位置的第二障碍物检测模组。In one embodiment of the present disclosure, the handling robot further includes an obstacle detection module, and the telescopic fork mechanism includes a pair of first and second telescopic arms arranged in parallel; the obstacle detection module is set There are at least two, respectively the first obstacle detection module set at the front end of the first telescopic arm, and the second obstacle detection module at the front end of the second telescopic arm.
在本公开的一个实施例中,所述取还箱组件包括用于承载料箱的料箱托盘,所述第一伸缩臂、第二伸缩臂设置在料箱托盘相对的两侧,且被配置为当第一障碍物检测模组、第二障碍物检测模组检测相应的伸出路径未被遮挡时,相对于所述料箱托盘伸出。In one embodiment of the present disclosure, the retrieving and returning box assembly includes a box tray for carrying the box, and the first telescopic arm and the second telescopic arm are arranged on opposite sides of the box tray and configured to When the first obstacle detection module and the second obstacle detection module detect that the corresponding extension paths are not blocked, they extend relative to the bin tray.
在本公开的一个实施例中,所述伸缩叉机构每组伸缩臂为一级伸出的伸缩臂,或者为至少两级伸出的伸缩臂;所述障碍物检测模组设置在伸缩叉机构末端伸缩臂的前端位置。In an embodiment of the present disclosure, each set of telescopic arms of the telescopic fork mechanism is a telescopic arm extended at one stage, or a telescopic arm extended at least two stages; the obstacle detection module is arranged on the telescopic fork mechanism The front end position of the end telescopic arm.
在本公开的一个实施例中,还包括控制单元,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组检测到相应的伸出路径均被遮挡时,发出停止取料箱指令,并上报异常;以及,In one embodiment of the present disclosure, a control unit is further included, and the control unit sends a stop call in response to the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension paths are blocked. bin command, and report an exception; and,
响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧移动相应的距离。In response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to move a corresponding distance to the blocked side.
根据本公开的第三方面,提供了一种取送箱方法,应用于上述的搬运机器人,包括取箱步骤和送箱步骤,所述取箱步骤和还箱步骤均包括以下步骤:According to a third aspect of the present disclosure, there is provided a method for picking up and delivering boxes, which is applied to the above-mentioned handling robot, including a box picking step and a box sending step, and the box picking step and box returning step both include the following steps:
步骤S1000,控制取还箱组件提升到目标高度;Step S1000, controlling the take-and-return box assembly to be lifted to the target height;
步骤S2000,控制障碍物检测模组探测伸缩叉机构的伸出路径是否被遮挡;Step S2000, controlling the obstacle detection module to detect whether the extension path of the telescopic fork mechanism is blocked;
步骤S3000,响应于障碍物检测模组检测到伸出路径未被遮挡,控制伸缩叉机构伸出。Step S3000, in response to the obstacle detection module detecting that the extending path is not blocked, controlling the telescopic fork mechanism to extend.
在本公开的一个实施例中,所述伸缩叉机构包括第一伸缩臂、第二伸缩臂,所述障碍物检测模组包括用于检测第一伸缩臂伸出路径是否被遮挡的第一障碍物检测模组,及用于检测第二伸缩臂伸出路径是否被遮挡的第二障碍物检测模组;In one embodiment of the present disclosure, the telescopic fork mechanism includes a first telescopic arm and a second telescopic arm, and the obstacle detection module includes a first obstacle for detecting whether the extending path of the first telescopic arm is blocked An object detection module, and a second obstacle detection module for detecting whether the extending path of the second telescopic arm is blocked;
所述步骤S2000包括:The step S2000 includes:
步骤S2100,控制第一障碍物检测模组、第二障碍物检测模组分别检测第一伸缩臂、第二伸缩臂的伸出路径是否被遮挡;Step S2100, controlling the first obstacle detection module and the second obstacle detection module to detect whether the extending paths of the first telescopic arm and the second telescopic arm are blocked;
步骤S2200,响应于第一障碍物检测模组、第二障碍物检测模组中的其中一个检测到相应的伸出路径被遮挡时,控制搬运机器人向被遮挡的一侧移动,直到该侧不被遮挡;以及Step S2200, in response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, control the handling robot to move to the blocked side until the side is cleared. is obscured; and
步骤S2300,响应于第一障碍物检测模组、第二障碍物检测模组检测到相应的伸出路径均被遮挡时,发出停止取料箱指令,并上报异常。Step S2300, when the first obstacle detection module and the second obstacle detection module detect that the corresponding extension paths are blocked, issue a command to stop the retrieving box and report an exception.
在本公开的一个实施例中,所述步骤S3000中,在控制伸缩叉机构伸出的过程中,障碍物检测模组实时检测伸缩叉机构的伸出路径是否被遮挡,以及当障碍物检测模组检测到伸出路径被遮挡时,控制伸缩叉机构停止伸出。In one embodiment of the present disclosure, in the step S3000, during the process of controlling the extension of the telescopic fork mechanism, the obstacle detection module detects in real time whether the extension path of the telescopic fork mechanism is blocked, and when the obstacle detection module When the group detects that the extending path is blocked, it controls the telescopic fork mechanism to stop extending.
在本公开的一个实施例中,在所述步骤S1000之后,还包括:In an embodiment of the present disclosure, after the step S1000, further includes:
二维成像模组检测与对应料架横梁上的标识的位置偏差,以及基于该位置偏差控制底盘组价在预定移动阈值范围内移动相应的距离;和/或控制取还箱组件升降相应的高度。The two-dimensional imaging module detects the positional deviation from the mark on the beam of the corresponding material rack, and based on the positional deviation, controls the chassis assembly to move a corresponding distance within a predetermined movement threshold; and/or controls the lifting and lowering of the return box assembly to a corresponding height .
在本公开的一个实施例中,取料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面;送料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面。In one embodiment of the present disclosure, when retrieving the material box, drive the retrieving and returning box assembly to lift to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack; when feeding the material box, drive the The take-and-return box assembly is lifted to make the load-bearing surface of the material box tray higher than the load-bearing surface for placing the material box on the material rack.
在本公开的一个实施例中,在取箱步骤中,在所述步骤S1000之后,还包括:In one embodiment of the present disclosure, in the box removal step, after the step S1000, further includes:
三维成像模组检测与对应料架上料箱的位置偏差,以及基于该位置偏差控制搬运机器人在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度。The three-dimensional imaging module detects the position deviation of the bin on the corresponding rack, and based on the position deviation controls the handling robot to move a corresponding distance within the predetermined movement threshold range; and/or controls the bin tray to rotate within the predetermined rotation threshold range corresponding angle.
根据本公开的第四方面,提供了一种取还箱方法,包括取箱步骤和送箱步骤,应用于搬运机器人,所述搬运机器人包括底盘组件、门架组件、取还箱组件,所述门架组件连接在所述底盘组件上;所述取还箱组件被构造为沿着所述门架组件上下移动,取还箱组件包括用于承载料箱的料箱托盘;还包括二维成像模组,包括以下步骤:According to a fourth aspect of the present disclosure, there is provided a method for retrieving and returning a box, including a step of taking a box and a step of sending a box, applied to a handling robot, the handling robot includes a chassis assembly, a door frame assembly, and a box retrieving assembly, the The gantry assembly is connected to the chassis assembly; the retrieving box assembly is configured to move up and down along the gantry assembly, and the retrieving box assembly includes a bin tray for carrying the bins; it also includes a two-dimensional imaging module, including the following steps:
S1000′,控制取还箱组件按照系统内预存的目标箱位的高度值提升到目标高度;S1000', controlling the retrieving and returning box assembly to be lifted to the target height according to the height value of the target box position pre-stored in the system;
S2000′,基于二维成像模组获得的目标箱位标识的位置,得到取还箱组件与标识之间的高度位置偏差;S2000', based on the position of the target box mark obtained by the two-dimensional imaging module, obtain the height position deviation between the retrieving box component and the mark;
S3000′,在取箱步骤中,基于获得的所述高度位置偏差,控制所述取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面;S3000', in the box taking step, based on the obtained height position deviation, control the lifting and returning box assembly so that the bearing surface of the material box tray is lower than the bearing surface for placing the material box on the material rack;
S4000′,在送箱步骤中,驱动所述取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面。S4000', in the box sending step, drive the take-and-return box assembly to lift to make the bearing surface of the material box tray higher than the bearing surface for placing material boxes on the material rack.
在本公开的一个实施例中,至少在所述送箱步骤中,还基于二维成像模组获得的目标箱位标识的位置,得到取还箱组件与标识之间的水平位置偏差;基于获得的所述水平位置偏差,控制底盘组件移动以调整取还箱组件的水平位移。In one embodiment of the present disclosure, at least in the box sending step, based on the position of the target box location mark obtained by the two-dimensional imaging module, the horizontal position deviation between the return box assembly and the mark is obtained; based on the obtained Said horizontal position deviation, control the movement of the chassis assembly to adjust the horizontal displacement of the retrieval box assembly.
在本公开的一个实施例中,在所述取箱步骤中,还包括:In one embodiment of the present disclosure, in the step of taking out the box, it also includes:
基于三维成像模组获取料箱的三维信息,得到取还箱组件与料箱之间的位置偏差;Obtain the three-dimensional information of the material box based on the three-dimensional imaging module, and obtain the position deviation between the retrieval box component and the material box;
控制底盘组件在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度。Controlling the chassis assembly to move a corresponding distance within a predetermined movement threshold range; and/or controlling the bin tray to rotate a corresponding angle within a predetermined rotation threshold range.
根据本公开的第五方面,提供了一种取箱方法,包括以下步骤:According to a fifth aspect of the present disclosure, there is provided a method for removing boxes, comprising the following steps:
步骤S1、搬运机器人行走至目标位置,控制取还箱组件提升至目标高度;Step S1, the handling robot walks to the target position, and controls the take-and-return box assembly to lift to the target height;
步骤S2、通过二维成像模组获取料架横梁上标识的位置信息,并基于得到的取还箱组件的位置偏差调整所述取还箱组件的位置;Step S2. Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly based on the obtained position deviation of the retrieval box assembly;
步骤S3、通过障碍物检测模组分别检测第一伸缩臂、第二伸缩臂前方的伸出路径是否被遮挡,Step S3, through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm and the second telescopic arm are blocked,
若两侧均被遮挡,则停止取箱,上报异常信息;If both sides are blocked, stop picking up boxes and report abnormal information;
若单侧被遮挡,则控制底盘组件向被遮挡一侧移动至两侧的伸出路径均未被遮挡,然后进行步骤S4;If one side is blocked, control the extension path of the chassis assembly to move from the blocked side to both sides without being blocked, and then proceed to step S4;
若两侧均无遮挡,则进行步骤S4;If there is no occlusion on both sides, proceed to step S4;
步骤S4、基于三维成像模组获取料箱的三维信息,获得取还箱组件与料箱之间的位置偏差;Step S4. Obtain the three-dimensional information of the material box based on the three-dimensional imaging module, and obtain the positional deviation between the retrieving and returning box assembly and the material box;
若所述取还箱组件与料箱的位置偏差在可允许范围外,控制底盘组件在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度;然后执行步骤S5;If the positional deviation between the retrieving and returning box assembly and the material box is outside the allowable range, control the chassis assembly to move a corresponding distance within a predetermined movement threshold; and/or control the material box tray to rotate within a predetermined rotation threshold Angle; then execute step S5;
步骤S5、控制取还箱组件伸出。Step S5, controlling the extension of the retrieval box assembly.
在本公开的一个实施例中,步骤S2中,基于取还箱组件的高度位置偏差调整所述取还箱组件的高度。In one embodiment of the present disclosure, in step S2, the height of the retrieval bin assembly is adjusted based on the height position deviation of the retrieval bin assembly.
根据本发明的第六方面,提供了一种送箱方法,包括以下步骤:According to a sixth aspect of the present invention, there is provided a box delivery method, comprising the following steps:
步骤S1、搬运机器人行走至目标位置,控制取还箱组件提升至目标高度;Step S1, the handling robot walks to the target position, and controls the take-and-return box assembly to lift to the target height;
步骤S2、通过二维成像模组获取料架横梁上标识的位置信息,并基于得到的位置偏差调整所述取还箱组件的位置;Step S2. Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly based on the obtained position deviation;
步骤S3、通过障碍物检测模组分别检测第一伸缩臂、第二伸缩臂前方的伸出路径是否被遮挡,Step S3, through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm and the second telescopic arm are blocked,
若至少一侧被遮挡,则停止送箱,上报异常;若两侧均无遮挡,则进行步骤S4;If at least one side is blocked, stop delivering boxes and report an abnormality; if both sides are not blocked, proceed to step S4;
步骤S4、控制取还箱组件伸出。Step S4, controlling the extension of the retrieval box assembly.
在本公开的一个实施例中,步骤S2中:In one embodiment of the present disclosure, in step S2:
基于取还箱组件的高度偏差调整所述取还箱组件的高度;adjusting the height of the retrieval bin assembly based on the height deviation of the retrieval bin assembly;
基于取还箱组件的水平偏差调整所述取还箱组件的水平位移。The horizontal displacement of the retrieval bin assembly is adjusted based on the horizontal deviation of the retrieval bin assembly.
本申请的一个有益效果在于,搬运机器人通过障碍物检测模组可以探测伸缩叉机构的伸出路径是否被遮挡。只有在不被遮挡的情况下,才会控制伸缩叉机构伸出,去料架上取料箱,或者将料箱推送至料架上进行储存。这保证了伸缩叉机构不会碰撞料箱,且保证了还箱时不会与其它料箱产生干涉,保证该料箱在料架上排列的规整性,极大的提高了取还箱过程的自动化、准确性和安全性。An advantageous effect of the present application is that the handling robot can detect whether the extension path of the telescopic fork mechanism is blocked through the obstacle detection module. Only when it is not blocked, will the telescopic fork mechanism be controlled to extend, remove the material box from the material rack, or push the material box to the material rack for storage. This ensures that the telescopic fork mechanism will not collide with the material box, and ensures that there will be no interference with other material boxes when returning the box, ensuring the regularity of the arrangement of the material box on the material rack, which greatly improves the efficiency of the box retrieval process. Automation, accuracy and security.
通过以下参照附图对本申请的示例性实施例的详细描述,本申请的其它特征及其优点将会变得清楚。Other features of the present application and advantages thereof will become apparent through the following detailed description of exemplary embodiments of the present application with reference to the accompanying drawings.
附图说明Description of drawings
被结合在说明书中并构成说明书的一部分的附图示出了本申请的实施例,并且连同其说明一起用于解释本申请的原理。The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate the embodiments of the application and together with the description serve to explain the principles of the application.
图1是本申请一实施例提供的搬运机器人整体结构示意图;Fig. 1 is a schematic diagram of the overall structure of a handling robot provided by an embodiment of the present application;
图2是本申请一实施例提供的搬运机器人取还箱组件一结构示意图;Fig. 2 is a structural schematic diagram of a handling robot retrieving and returning box assembly provided by an embodiment of the present application;
图3是本申请一实施例提供的搬运机器人取还箱组件另一结构示意图;Fig. 3 is a schematic diagram of another structure of the retrieving and returning box assembly of the handling robot provided by an embodiment of the present application;
图4是本申请一实施例提供的搬运机器人取还箱组件底部的结构示意图;Fig. 4 is a schematic structural view of the bottom of the retrieving and returning box assembly of the handling robot provided by an embodiment of the present application;
图1至图4中各组件名称和附图标记之间的一一对应关系如下:The one-to-one correspondence between the names of the components and the reference numerals in Fig. 1 to Fig. 4 is as follows:
100、底盘组件;200、门架组件;300、取还箱组件;310、第一伸缩臂;320、第二伸缩臂;330、料箱托盘;340、前拨齿;350、后拨齿;360、基座;370、旋转机构;410、第一障碍物检测模组;420、第二障碍物检测模组;500、三维成像模组;600、二维成像模组。100. Chassis assembly; 200. Mast assembly; 300. Retrieval box assembly; 310. First telescopic arm; 320. Second telescopic arm; 330. Material box tray; 340. Front gear; 350. Rear gear; 360. Base; 370. Rotation mechanism; 410. First obstacle detection module; 420. Second obstacle detection module; 500. Three-dimensional imaging module; 600. Two-dimensional imaging module.
具体实施方式Detailed ways
现在将参照附图来详细描述本申请的各种示例性实施例。应注意到:除非另外具体说明,否则在这些实施例中阐述的部件和步骤的相对布置、数字表达式和数值不限制本申请的范围。Various exemplary embodiments of the present application will now be described in detail with reference to the accompanying drawings. It should be noted that the relative arrangements of components and steps, numerical expressions and numerical values set forth in these embodiments do not limit the scope of the present application unless specifically stated otherwise.
以下对至少一个示例性实施例的描述实际上仅仅是说明性的,决不作为对本申请及其应用或使用的任何限制。The following description of at least one exemplary embodiment is merely illustrative in nature and in no way serves as any limitation of the application, its application or uses.
对于相关领域普通技术人员已知的技术、方法和设备可能不作详细讨论,但在适当情况下,所述技术、方法和设备应当被视为说明书的一部分。Techniques, methods and devices known to those of ordinary skill in the relevant art may not be discussed in detail, but where appropriate, such techniques, methods and devices should be considered part of the description.
在这里示出和讨论的所有例子中,任何具体值应被解释为仅仅是示例性的,而不是作为限制。因此,示例性实施例的其它例子可以具有不同的值。In all examples shown and discussed herein, any specific values should be construed as exemplary only, and not as limitations. Therefore, other instances of the exemplary embodiment may have different values.
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步讨论。It should be noted that like numerals and letters denote like items in the following figures, therefore, once an item is defined in one figure, it does not require further discussion in subsequent figures.
本申请提供了一种搬运机器人,如图1至图4所示,包括底盘组件100、门架组件200、取还箱组件300以及障碍物检测模组。底盘组件100能够在地面行走,门架组件200竖立设置并连接在底盘组件100上。取还箱组件300连接在门架组件200上,并且被构造为沿着门架组件200上下移动,取还箱组件300还包括伸缩叉机构,伸缩叉机构能够沿水平方 向伸出或缩回,并勾取或者推送料箱。障碍物检测模组被配置为用于探测伸缩叉机构的伸出路径是否被遮挡,伸缩叉机构被配置为:当障碍物检测模组探测伸缩叉机构的伸出路径无遮挡时伸出。The present application provides a handling robot, as shown in FIGS. 1 to 4 , including a chassis assembly 100 , a door frame assembly 200 , a retrieving and returning box assembly 300 and an obstacle detection module. The chassis assembly 100 can walk on the ground, and the mast assembly 200 is erected and connected to the chassis assembly 100 . The retrieval box assembly 300 is connected to the door frame assembly 200 and is configured to move up and down along the door frame assembly 200. The retrieval box assembly 300 also includes a telescopic fork mechanism that can extend or retract in the horizontal direction. And tick or push the material box. The obstacle detection module is configured to detect whether the extension path of the telescopic fork mechanism is blocked, and the telescopic fork mechanism is configured to extend when the obstacle detection module detects that the extension path of the telescopic fork mechanism is not blocked.
搬运机器人在取还料箱的过程中,可以通过障碍物检测模组探测伸缩叉机构的伸出路径是否被遮挡,来判断伸缩叉机构与料箱的相对位置。当料箱挡在伸缩叉机构的伸出路径上,或者料箱附近存在其他障碍物挡在伸缩叉机构的伸出路径上,障碍物检测模组均能够识别,以免伸缩叉机构与料箱或其他障碍物发生碰撞。只有当障碍物检测模组检测到伸缩叉机构的伸出路径未被遮挡时,才允许取还箱组件伸出,以将位于料架上的料箱勾取到搬运机器人上,或者将搬运机器人上的料箱推送到料架上进行储存。这样可避免伸缩叉机构在伸出的过程中与料箱发生碰撞,以造成该料箱或者相邻的其它料箱发生严重的错位,保证了取箱过程的安全性。During the process of taking and returning the material box, the handling robot can detect whether the extension path of the telescopic fork mechanism is blocked through the obstacle detection module to judge the relative position of the telescopic fork mechanism and the material box. When the material box blocks the extension path of the telescopic fork mechanism, or there are other obstacles near the material box that block the extension path of the telescopic fork mechanism, the obstacle detection module can identify them to prevent the telescopic fork mechanism from colliding with the material box or Collision with other obstacles. Only when the obstacle detection module detects that the extension path of the telescopic fork mechanism is not blocked, the retrieval box assembly is allowed to extend, so as to hook the material box on the material rack to the handling robot, or to move the handling robot The upper material box is pushed to the material rack for storage. This can prevent the telescopic fork mechanism from colliding with the material box during the stretching process, causing serious misalignment of the material box or other adjacent material boxes, thereby ensuring the safety of the box removal process.
取还箱组件300的伸缩叉机构包括一对平行布置的第一伸缩臂310和第二伸缩臂320,取还箱过程中,第一伸缩臂310和第二伸缩臂320通过同一驱动单元进行驱动,使其能够同时伸出至料箱的相对两侧。The telescopic fork mechanism of the retrieving and returning box assembly 300 includes a pair of first telescopic arms 310 and second telescopic arms 320 arranged in parallel, during the process of retrieving and returning the box, the first telescopic arms 310 and the second telescopic arms 320 are driven by the same drive unit , allowing it to reach out to opposite sides of the bin simultaneously.
障碍物检测模组设置有至少两个,分别为设置在第一伸缩臂310前端位置的第一障碍物检测模组410,以及位于第二伸缩臂320前端位置的第二障碍物检测模组420。第一障碍物检测模组410的检测方向为第一伸缩臂310的伸出方向,第二障碍物检测模组420的检测方向为第二伸缩臂320的伸出方向。There are at least two obstacle detection modules, namely the first obstacle detection module 410 located at the front end of the first telescopic arm 310 and the second obstacle detection module 420 located at the front end of the second telescopic arm 320 . The detection direction of the first obstacle detection module 410 is the extension direction of the first telescopic arm 310 , and the detection direction of the second obstacle detection module 420 is the extension direction of the second telescopic arm 320 .
障碍物检测模组可以是激光传感器或红外传感器等光电传感器,能够在设置的探测深度范围内探测前方是否存在障碍物。例如激光传感器可以向探测方向发射激光束,当前方有障碍物时,则发射的激光束会打到障碍物上,此时可以被激光传感器检测到,此时也可以理解为激光传感器或红外传感器被触发,发出被触发的电信号。当第一障碍物检测模组410和第二障碍物检测模组420的探测范围内没有检测到障碍物,或者检测到的障碍物超出第一伸缩臂310、第二伸缩臂320的伸出距离时,则认为伸缩叉机构的伸出路径无遮挡。The obstacle detection module can be a photoelectric sensor such as a laser sensor or an infrared sensor, which can detect whether there is an obstacle in front within the set detection depth range. For example, a laser sensor can emit a laser beam in the detection direction. When there is an obstacle in front, the emitted laser beam will hit the obstacle. At this time, it can be detected by the laser sensor. At this time, it can also be understood as a laser sensor or an infrared sensor. To be triggered, to emit a triggered electrical signal. When no obstacle is detected within the detection range of the first obstacle detection module 410 and the second obstacle detection module 420, or the detected obstacle exceeds the extension distance of the first telescopic arm 310 and the second telescopic arm 320 , it is considered that the extension path of the telescopic fork mechanism is unobstructed.
第一伸缩臂310和第二伸缩臂320是同时动作的,当第一障碍物检测模组410、第二障碍物检测模组420的其中任意一个被触发,第一伸缩臂310和第二伸缩臂320均不伸出。The first telescopic arm 310 and the second telescopic arm 320 act simultaneously. When any one of the first obstacle detection module 410 and the second obstacle detection module 420 is triggered, the first telescopic arm 310 and the second telescopic arm 310 Neither arm 320 is extended.
障碍物检测模组还被配置为能够在伸缩叉机构伸出的过程中进行实时检测。若在伸缩叉机构伸出的过程中,由于各种因素造成料箱偏移或者其它原因,只要在伸缩叉机构的伸出路径上出现障碍物,障碍物检测模组能够立即被触发,伸缩叉机构停止伸出动作,以免撞上障碍物。该过程中,第一伸缩臂310和第二伸缩臂320保持动作同步,当第一障碍物检测模组410、第二障碍物检测模组420的任意一个被触发,第一伸缩臂310和第二伸缩臂320同时停止伸出动作。The obstacle detection module is also configured to be able to perform real-time detection during the extension of the telescopic fork mechanism. If during the extension process of the telescopic fork mechanism, due to various factors, the material box is offset or other reasons, as long as there is an obstacle on the extension path of the telescopic fork mechanism, the obstacle detection module can be triggered immediately, and the telescopic fork The mechanism stops the extension motion so as not to hit the obstacle. During this process, the first telescopic arm 310 and the second telescopic arm 320 keep moving synchronously. When any one of the first obstacle detection module 410 and the second obstacle detection module 420 is triggered, the first telescopic arm 310 and the second The two telescopic arms 320 stop extending simultaneously.
取还箱组件300包括用于承载料箱的料箱托盘330,第一伸缩臂310和第二伸缩臂320设置在料箱托盘330的相对两侧,且被配置为当第一障碍物检测模组410、第二障碍物检测模组420未被触发时,相对于料箱托盘330伸出。The retrieving and returning box assembly 300 includes a box tray 330 for carrying the box, the first telescopic arm 310 and the second telescopic arm 320 are arranged on opposite sides of the box tray 330, and are configured to be used when the first obstacle detection module When the group 410 and the second obstacle detection module 420 are not triggered, they protrude relative to the bin tray 330 .
第一伸缩臂310和第二伸缩臂320的前端位置均设置有前拨齿340,两个前拨齿340能够相对第一伸缩臂310、第二伸缩臂320运动。初始状态时,两个前拨齿340位于两个伸缩臂的开口之外,以避免前拨齿340对料箱形成干涉。两个前拨齿340例如可以转动至与伸缩臂的端面齐平,或者在伸缩臂伸出端的端面范围内。第一伸缩臂310和第二伸缩臂320伸出后,使得料箱可以通过该开口进入到两个伸缩臂之间。在取走料箱过程中,第一伸缩臂310和第二伸缩臂320伸出到位后,两个前拨齿340运动至两个伸缩臂的开口位置,以对料箱的后端面形成阻挡。第一伸缩臂310和第二伸缩臂320缩回时两个前拨齿340能够将料箱勾回至料箱托盘330上。Both the front ends of the first telescopic arm 310 and the second telescopic arm 320 are provided with front shifting teeth 340 , and the two front shifting teeth 340 can move relative to the first telescopic arm 310 and the second telescopic arm 320 . In the initial state, the two front teeth 340 are located outside the openings of the two telescopic arms, so as to prevent the front teeth 340 from interfering with the material box. For example, the two front shifting teeth 340 can be rotated to be flush with the end face of the telescopic arm, or within the range of the end face of the extended end of the telescopic arm. After the first telescopic arm 310 and the second telescopic arm 320 are stretched out, the material box can enter between the two telescopic arms through the opening. In the process of removing the material box, after the first telescopic arm 310 and the second telescopic arm 320 stretch out into place, the two front shifting teeth 340 move to the opening positions of the two telescopic arms to form a block on the rear end surface of the material box. When the first telescopic arm 310 and the second telescopic arm 320 are retracted, the two front shifting teeth 340 can hook the material box back onto the material box tray 330 .
第一伸缩臂310和第二伸缩臂320的后端位置还设置有后拨齿350,在还箱过程中,第一伸缩臂310和第二伸缩臂320伸出时,后拨齿350能够将料箱托盘330上的料箱推出,从而将料箱推送至指定位置。The rear end position of the first telescopic arm 310 and the second telescopic arm 320 is also provided with a rear shifting tooth 350, and in the process of returning the box, when the first telescopic arm 310 and the second telescopic arm 320 are stretched out, the rear shifting tooth 350 can move the The material box on the material box tray 330 is pushed out, thereby pushing the material box to a designated position.
伸缩叉机构每组伸缩臂可以为一级伸出的伸缩臂结构,或者为至少两级伸出的伸缩臂结构。在此,一级伸出的伸缩臂结构指的是往伸出方向伸出一级伸缩臂。例如在具体应用中,伸缩臂滑动连接在料箱托盘330上,在相应的驱动机构控制下使得伸缩臂可以相对于料箱托盘330伸出。其中,料箱托盘的侧壁可以理解为第一级伸缩臂,用于伸出的伸缩臂则可以记为第二级伸缩臂。在伸出的过程中,料箱托盘330的第一级伸缩臂保持静止,第二级伸缩臂相对于第一级伸缩臂往伸出方向伸出。Each group of telescopic arms of the telescopic fork mechanism can be a telescopic arm structure with one stage of extension, or a telescopic arm structure with at least two stages of extension. Here, the telescopic arm structure with one stage of extension refers to extending one stage of the telescopic arm toward the extending direction. For example, in a specific application, the telescopic arm is slidably connected to the bin tray 330 , and the telescopic arm can extend relative to the bin tray 330 under the control of a corresponding driving mechanism. Wherein, the side wall of the material box tray can be understood as the first-stage telescopic arm, and the telescopic arm for extending can be recorded as the second-stage telescopic arm. During the extending process, the first-stage telescopic arm of the bin tray 330 remains stationary, and the second-stage telescopic arm extends toward the extending direction relative to the first-stage telescopic arm.
对于两级伸出的伸缩臂结构而言,例如当料箱托盘的侧壁记为第一级伸缩臂时,二级伸出的伸缩臂可以分别记为第二级伸缩臂、第三级伸缩臂。在伸出的过程中,料箱托盘330的第一级伸缩臂保持静止,第二级伸缩臂相对于第一级伸缩臂往伸出方向伸出,第三级伸缩臂相对于第二级伸缩臂往伸出方向继续伸出。第二级伸缩臂、第三级伸缩臂依次或者同时伸出,由此可以提高伸缩臂的伸出长度。伸缩臂采用几级伸缩可以根据不同情况做出调整,例如每节伸缩臂长度有变化时,对应的伸缩级别也可以做出对应调整,当每节伸缩臂长度变短时,则可以采用三级伸缩臂取二级伸缩臂(伸缩臂较长)取到的货物。For the structure of the two-stage extended telescopic arm, for example, when the side wall of the container tray is recorded as the first-stage telescopic arm, the two-stage extended telescopic arm can be respectively recorded as the second-stage telescopic arm and the third-stage telescopic arm. arm. During the extension process, the first-stage telescopic arm of the bin tray 330 remains stationary, the second-stage telescopic arm stretches out relative to the first-stage telescopic arm, and the third-stage telescopic arm stretches relative to the second-stage telescopic arm. The arm continues to extend in the extended direction. The telescopic arms of the second stage and the telescopic arms of the third stage are stretched out sequentially or simultaneously, thereby the extension length of the telescopic arms can be increased. The telescopic arm adopts several stages of telescopic expansion and can be adjusted according to different situations. For example, when the length of each telescopic arm changes, the corresponding telescopic level can also be adjusted accordingly. When the length of each telescopic arm becomes shorter, three levels can be used. The telescopic arm takes the goods picked up by the secondary telescopic arm (the telescopic arm is longer).
伸缩叉机构每组伸缩臂具体可以根据不同的应用的场景进行调整,例如当仓库料架中是单深位储存或者双深位储存时,则需要对应选择合适的伸缩臂结构,以完成单深位取货、双深位取货。对应双深位取货时,伸缩叉机构通常会采用两级伸出的伸缩臂结构,即,两级伸缩臂结合在一起,在工作时,两级伸缩臂在料箱托盘的基础上依次或同时展开。障碍物检测模组设置在伸缩叉机构末端伸缩臂的前端位置,两个前拨齿340也分别设置在伸缩叉机构两个末端伸缩臂的前端位置。这样可避免障碍物检测模组的探测路径被伸缩臂自身的某些机构遮挡。Each group of telescopic arms of telescopic fork mechanism can be adjusted according to different application scenarios. Single-position pick-up, double-deep pick-up. When corresponding to double-deep pick-up, the telescopic fork mechanism usually adopts a two-stage telescopic arm structure, that is, the two-stage telescopic arms are combined together. When working, the two-stage telescopic arms are sequentially or Simultaneously unfold. The obstacle detection module is arranged at the front end of the telescopic arm at the end of the telescopic fork mechanism, and the two front shifting teeth 340 are also respectively arranged at the front end of the telescopic arm at the two ends of the telescopic fork mechanism. This can prevent the detection path of the obstacle detection module from being blocked by some mechanism of the telescopic arm itself.
当然,对于本领域的技术人员而言,当对应于单深位取还箱时,可以采用一级伸出的伸缩臂结构,也可以采用两级伸出的伸缩臂结构。例如当采用两级伸出的伸缩臂时,只控制其中一级伸缩臂伸出即可完成在单深位取还箱。Of course, for those skilled in the art, when corresponding to a single-deep retrieval box, a telescopic arm structure with one-stage extension or a telescopic arm structure with two-stage extension can be used. For example, when two-stage telescopic arms are used, only one stage of telescopic arms can be controlled to stretch out to complete retrieving and returning boxes at a single deep position.
取还箱组件300上设置有伸缩驱动单元,伸缩驱动单元用于驱动伸缩叉机构伸出或缩回,以及驱动两个前拨齿340运动的驱动单元。伸缩驱动单元可以采用旋转电机、直线电机、齿轮组等,配合相应的传动机构实现伸缩叉机构的运动,本领域技术人员基于现有技术能够实现。The retrieval box assembly 300 is provided with a telescopic drive unit, which is used to drive the telescopic fork mechanism to extend or retract, and to drive the two front shifting teeth 340 to move. The telescopic drive unit can use a rotary motor, a linear motor, a gear set, etc., and cooperate with a corresponding transmission mechanism to realize the movement of the telescopic fork mechanism, which can be realized by those skilled in the art based on the prior art.
搬运机器人包括控制单元,控制单元能够接收障碍物检测模组的检测信号,并且底盘组件100、取还箱组件300均受控于控制单元。控制单元能够基于取箱命令或还箱命令,控制底盘组件100行走至地面的目标位置,并控制取还箱组件300移动至需要取还料箱的高度,然后控制取还箱组件300取走或还料箱。The handling robot includes a control unit, which can receive the detection signal of the obstacle detection module, and the chassis assembly 100 and the retrieving box assembly 300 are all controlled by the control unit. The control unit can control the chassis assembly 100 to walk to the target position on the ground based on the command to take out the box or the command to return the box, and control the box assembly 300 to move to the height where the box needs to be picked up and returned, and then control the box assembly 300 to take away or Return box.
在取箱过程中,当控制单元响应于第一障碍物检测模组410、第二障碍物检测模组420检测到相应的伸出路径均被遮挡时,向取还箱组件300发出停止取料箱指令,并上报异常。控制单元响应于第一障碍物检测模组410、第二障碍物检测模组420中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件100向该被遮挡的一侧移动相应的距离,以调整取还箱组件300的位置使被遮挡的一侧可以避免障碍物或者避开料箱。通过这种方式可以调整至第一伸缩臂310和第二伸缩臂320的伸出路径均未被遮挡。当第一障碍物检测模组410、第二障碍物检测模组420检测相应的伸出路径均未被遮挡后,控制单元向取还箱组件300发出伸出的指令。During the process of picking up the box, when the control unit detects that the corresponding extension paths are blocked in response to the first obstacle detection module 410 and the second obstacle detection module 420, it sends a stop picking to the box assembly 300 Box instructions and report exceptions. In response to one of the first obstacle detection module 410 and the second obstacle detection module 420 detecting that the corresponding extension path is blocked, the control unit controls the chassis assembly 100 to move a corresponding distance to the blocked side , to adjust the position of the retrieving box assembly 300 so that the side that is covered can avoid obstacles or avoid the material box. In this way, it can be adjusted until the extension paths of the first telescopic arm 310 and the second telescopic arm 320 are not blocked. When the first obstacle detection module 410 and the second obstacle detection module 420 detect that the corresponding extension paths are not blocked, the control unit sends an extension command to the retrieval box assembly 300 .
在本公开一个具体的实施方式中,第一伸缩臂310位于伸缩叉机构的左侧、第二伸缩臂320位于伸缩叉机构的右侧。当第一障碍物检测模组410检测第一伸缩臂310的伸出路径被遮挡,而第二障碍物检测模组420检测到第二伸缩臂320的伸出路径未被遮挡时,控制单元接收到第一障碍物检测模组410、第二障碍物检测模组420的检测信息后,控制底盘组件向第一伸缩臂所在的方向移动,即向左侧移动,从而使得第一伸缩臂310可以避开障碍物。In a specific embodiment of the present disclosure, the first telescopic arm 310 is located on the left side of the telescopic fork mechanism, and the second telescopic arm 320 is located on the right side of the telescopic fork mechanism. When the first obstacle detection module 410 detects that the extension path of the first telescopic arm 310 is blocked, and the second obstacle detection module 420 detects that the extension path of the second telescopic arm 320 is not blocked, the control unit receives After receiving the detection information from the first obstacle detection module 410 and the second obstacle detection module 420, control the chassis assembly to move to the direction where the first telescopic arm is located, that is, to move to the left, so that the first telescopic arm 310 can Avoid obstacles.
由于控制单元只是基于障碍物检测模组是否被触发而发出控制底盘组件移动的指令, 因此需要预设每次移动的距离。底盘组件每次移动相应的距离后,第一障碍物检测模组410、第二障碍物检测模组420再次探测,直到第一障碍物检测模组410、第二障碍物检测模组420检测到相应的伸出路径均未被遮挡。Since the control unit only issues an instruction to control the movement of the chassis assembly based on whether the obstacle detection module is triggered, the distance for each movement needs to be preset. After the chassis assembly moves a corresponding distance each time, the first obstacle detection module 410 and the second obstacle detection module 420 detect again until the first obstacle detection module 410 and the second obstacle detection module 420 detect None of the corresponding projection paths are blocked.
为了安全性考虑,在基于障碍物检测模组触发的电信号控制底盘组件移动的过程中,需要设置预定移动阈值,即最大移动距离。这是由于在具体的应用场景中,料架上料箱位的尺寸大于料箱的尺寸,在料箱两侧留出容供取还箱组件300的伸缩叉机构通过的空间。基于在通过底盘组件100调整两个伸缩臂相对料箱的位置时,调整幅度应当限制在料箱位的范围内,否则会碰撞到其它料箱、料架,或者发生其它不可控的事故。For the sake of safety, in the process of controlling the movement of the chassis assembly based on the electrical signal triggered by the obstacle detection module, a predetermined movement threshold, that is, a maximum movement distance, needs to be set. This is because in a specific application scenario, the size of the loading box position on the material rack is larger than the size of the material box, and space is reserved on both sides of the material box for the telescopic fork mechanism of the retrieving and returning box assembly 300 to pass through. Based on the adjustment of the position of the two telescopic arms relative to the material box through the chassis assembly 100, the adjustment range should be limited within the range of the material box position, otherwise it will collide with other material boxes, material racks, or other uncontrollable accidents will occur.
控制单元在该最大移动距离范围内调整两个伸缩臂相对于料箱的位移。如果在该最大移动距离范围内依然无法调整至使两个伸缩臂的伸出路径无遮挡,则可以停止取还箱,向系统发出异常信号。机器人可以放弃此次取还箱动作,等待系统分配其它任务。The control unit adjusts the displacement of the two telescopic arms relative to the material box within the range of the maximum moving distance. If it still cannot be adjusted to make the extending paths of the two telescopic arms unobstructed within the range of the maximum moving distance, it is possible to stop retrieving the box and send an abnormal signal to the system. The robot can give up the action of picking up and returning the box and wait for the system to assign other tasks.
第一障碍物检测模组410和第二障碍物检测模组420包括两个工作阶段,一个是在伸缩叉机构伸出之前,此时还处于调整阶段,则允许底盘组件100调整位置。第二个是伸缩叉机构伸出过程中,此时处于伸出取还箱阶段,不再允许底盘组件100调整位置。The first obstacle detection module 410 and the second obstacle detection module 420 include two working stages, one is before the telescopic fork mechanism is extended, and it is still in the adjustment stage, allowing the chassis assembly 100 to adjust its position. The second is during the extension process of the telescopic fork mechanism. At this time, it is in the stage of extending the retrieval box, and the chassis assembly 100 is no longer allowed to adjust its position.
在本公开一个实施方式中,在伸缩叉机构伸出之前,控制单元响应于第一障碍物检测模组410、第二障碍物检测模组420中其中一个被触发的电信号,控制底盘组件100向该被触发的一侧移动相应的距离,将伸缩叉机构调整至合适位置。In one embodiment of the present disclosure, before the extension of the telescopic fork mechanism, the control unit controls the chassis assembly 100 in response to an electrical signal that one of the first obstacle detection module 410 and the second obstacle detection module 420 is triggered. Move the corresponding distance to the triggered side to adjust the telescopic fork mechanism to a suitable position.
在本公开一个实施方式中,在伸缩叉机构伸出过程中,控制单元响应于第一障碍物检测模组410、第二障碍物检测模组420实时检测时被触发的至少一个电信号,控制伸缩叉机构停止伸出,不再进行取箱动作。即在伸缩叉机构伸出的过程中,第一障碍物检测模组410、第二障碍物检测模组420实时检测。如果第一障碍物检测模组410、第二障碍物检测模组420检测到某侧伸缩臂的伸出路径被遮挡,控制单元则控制伸缩叉机构停止伸出。In one embodiment of the present disclosure, during the extending process of the telescopic fork mechanism, the control unit controls The telescopic fork mechanism stops stretching out, and does not carry out the box-taking action any more. That is, during the extension process of the telescopic fork mechanism, the first obstacle detection module 410 and the second obstacle detection module 420 detect in real time. If the first obstacle detection module 410 and the second obstacle detection module 420 detect that the extending path of the telescopic arm on a certain side is blocked, the control unit controls the telescopic fork mechanism to stop extending.
伸缩叉机构停止伸出后,控制单元可以控制伸缩叉单元缩回,然后再基于障碍物检测模组的检测信号调整底盘组件100的位置,或者放弃此次取还箱操作,上报业务系统,等待系统分配其它任务。After the telescopic fork mechanism stops extending, the control unit can control the retraction of the telescopic fork unit, and then adjust the position of the chassis assembly 100 based on the detection signal of the obstacle detection module, or give up the operation of picking up and returning the box, report to the business system, and wait The system assigns other tasks.
在本公开一个实施方式中,为了进一步调整取还箱组件300相对料架上料箱的位置,在取还箱组件300上设置有三维成像模组500,三维成像模组500被配置为用于获取料箱的三维位置信息。In one embodiment of the present disclosure, in order to further adjust the position of the take-and-return box assembly 300 relative to the loading box on the rack, a three-dimensional imaging module 500 is provided on the take-and-return box assembly 300, and the three-dimensional imaging module 500 is configured for Obtain the three-dimensional position information of the material box.
三维成像模组500可以是深度相机或全景相机,也可以为多个相机的组合,只要其能够获取料箱的三维成像信息即可。三维成像模组500能够将其获取的三维位置信息发送至控制单元。The three-dimensional imaging module 500 can be a depth camera or a panoramic camera, or a combination of multiple cameras, as long as it can obtain the three-dimensional imaging information of the material box. The 3D imaging module 500 can send the acquired 3D position information to the control unit.
三维成像模组500获得其前方料箱的三维位置后,可以得到料箱与三维成像模组500或取还箱组件300的三维偏差,这包括了水平偏差和角度偏差,控制单元后续可以基于水平偏差和角度偏差调整取还箱组件300的位置。因此在一个具体的安装结构中,取还箱组件300的料箱托盘330后端设置有后挡板,三维成像模组500可以设置在后挡板的中心位置,并正对伸缩叉机构的伸出方向。将三维成像模组500设置在后挡板的中心位置,这是为了便于与料箱的中心位置对准。After the three-dimensional imaging module 500 obtains the three-dimensional position of the material box in front of it, it can obtain the three-dimensional deviation between the material box and the three-dimensional imaging module 500 or the retrieval box assembly 300, which includes horizontal deviation and angular deviation. The offset and angular offset adjust the position of the retrieval bin assembly 300 . Therefore, in a specific installation structure, the rear end of the bin tray 330 of the retrieving and returning box assembly 300 is provided with a rear baffle, and the three-dimensional imaging module 500 can be arranged at the center of the rear baffle, facing the extension of the telescopic fork mechanism. out direction. The three-dimensional imaging module 500 is arranged at the center of the tailgate, which is for the convenience of being aligned with the center of the material box.
参考图3、图4,取还箱组件300包括基座360和旋转机构370,料箱托盘330通过旋转机构370安装在基座360上,使得料箱托盘330可以相对于基座360转动。旋转机构370可以包括旋转驱动单元、连接基座360和料箱托盘330之间的回转轴承,旋转驱动单元接收控制单元的相应控制指令驱动料箱托盘旋转。旋转驱动单元包括但不限制于旋转电机、齿轮组等,本领域技术人员基于现有技术能够实现。需要注意的是,基座360也可被称为升降组件,即该基座360可导向配合在门架组件上,并通过相应的驱动机构控制基座360在门架组件上的升降,在此不再具体说明。Referring to FIG. 3 and FIG. 4 , the retrieval box assembly 300 includes a base 360 and a rotation mechanism 370 , and the bin tray 330 is mounted on the base 360 through the rotation mechanism 370 so that the bin tray 330 can rotate relative to the base 360 . The rotation mechanism 370 may include a rotation driving unit, a slewing bearing connecting the base 360 and the bin tray 330 , and the rotation driving unit receives a corresponding control command from the control unit to drive the bin tray to rotate. The rotary drive unit includes but is not limited to a rotary motor, a gear set, etc., and those skilled in the art can realize based on the existing technology. It should be noted that the base 360 can also be called a lifting assembly, that is, the base 360 can be guided and fitted on the door frame assembly, and the lifting of the base 360 on the door frame assembly is controlled by a corresponding driving mechanism. No more specific instructions.
在本公开一个实施方式中,控制单元被配置为基于三维成像模组500获得的料箱的位置偏差,控制底盘组件100在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘 330在预定转动阈值范围内转动相应的角度。In one embodiment of the present disclosure, the control unit is configured to control the chassis assembly 100 to move a corresponding distance within a predetermined movement threshold range based on the position deviation of the bin obtained by the three-dimensional imaging module 500; and/or, control the bin tray 330 rotates by a corresponding angle within a predetermined rotation threshold.
三维成像模组500例如可以采用深度相机,通过深度相机例如可获得料箱在三维空间中的位置,基于此信息可以得到料箱与取还箱组件之间的水平偏移、高度偏移、角度偏移信息。例如,可以计算料箱前侧若干个点的距离信息,并根据该距离信息判断料箱偏转的角度。再例如,深度相机获得料箱的图像后,可以分析料箱的中心与取还箱组件中心之间的偏差,以此作为料箱水平、高度偏移的距离等。这种通过深度相机获得料箱图像,并判断料箱位置偏差的技术属于本领域技术人员的公知常识,在此不再具体说明。The 3D imaging module 500 can, for example, use a depth camera. Through the depth camera, for example, the position of the material box in the three-dimensional space can be obtained. Based on this information, the horizontal offset, height offset, and angle between the material box and the return box assembly can be obtained. offset information. For example, the distance information of several points on the front side of the material box can be calculated, and the deflection angle of the material box can be judged according to the distance information. For another example, after the depth camera obtains the image of the material box, it can analyze the deviation between the center of the material box and the center of the return box assembly, and use it as the distance of the level and height of the material box. The technology of obtaining the image of the material box through the depth camera and judging the position deviation of the material box belongs to the common knowledge of those skilled in the art, and will not be described in detail here.
在本公开一个实施方式中,控制单元基于得到的料箱与取还箱组件之间的水平偏差,控制底盘组件100向预定的方向移动相应的距离。由于三维成像模组500获得的是料箱的三维位置信息,因此可得到料箱水平偏移的距离,控制单元基于该水平偏移量可直接驱动底盘组件100向预定的方向移动相应的距离。In one embodiment of the present disclosure, the control unit controls the chassis assembly 100 to move a corresponding distance in a predetermined direction based on the obtained horizontal deviation between the material box and the retrieving box assembly. Since the 3D imaging module 500 obtains the 3D position information of the container, it can obtain the horizontal offset distance of the container, and the control unit can directly drive the chassis assembly 100 to move a corresponding distance in a predetermined direction based on the horizontal offset.
为了安全考虑,控制单元驱动底盘组件100在预定移动阈值范围内移动相应的距离。该预定移动阈值为移动的最大的距离。如果需要移动的距离超出该预定移动阈值,则停止取还箱,上报异常。机器人可以放弃此次取还箱动作,等待系统分配其它任务。For safety considerations, the control unit drives the chassis assembly 100 to move a corresponding distance within a predetermined movement threshold range. The predetermined moving threshold is the maximum moving distance. If the distance to be moved exceeds the predetermined movement threshold, the box will be stopped and an exception will be reported. The robot can give up the action of picking up and returning the box and wait for the system to assign other tasks.
在本公开一个实施方式中,控制单元基于得到的料箱与取还箱组件之间的角度偏差,控制料箱托盘330相对于基座转动相应的角度。由于三维成像模组500获得的是料箱的三维位置信息,由此可得到料箱具体的偏移角度,控制单元基于该偏移角度可直接驱动料箱托盘330向预定的方向转动相应的角度。In one embodiment of the present disclosure, the control unit controls the bin tray 330 to rotate by a corresponding angle relative to the base based on the obtained angle deviation between the bin and the retrieving bin assembly. Since the three-dimensional imaging module 500 obtains the three-dimensional position information of the material box, the specific offset angle of the material box can be obtained, and the control unit can directly drive the material box tray 330 to rotate the corresponding angle in a predetermined direction based on the offset angle. .
为了安全考虑,控制单元驱动料箱托盘330在预定转动阈值范围内转动相应的角度。该预定转动阈值为转动的最大的角度。如果超出该预定移动阈值,则停止取还箱,上报异常。机器人可以放弃此次取还箱动作,等待系统分配其它任务。For safety considerations, the control unit drives the bin tray 330 to rotate by a corresponding angle within a predetermined rotation threshold range. The predetermined rotation threshold is the maximum angle of rotation. If the predetermined movement threshold is exceeded, the box will be stopped and an exception will be reported. The robot can give up the action of picking up and returning the box and wait for the system to assign other tasks.
在基于三维成像模组调整取还箱组件相对于料箱的位置时,可以先控制底盘组件调整水平偏移,也可以先控制料箱托盘调节角度偏移,在此不做限制。通过三维成像模组可以使取还箱组件的中心与料箱的中心对准,相对于传统的方法,可避免在料箱上贴标签,而且提升了对准的精度,降低了成本。When adjusting the position of the retrieving and returning box assembly relative to the material box based on the three-dimensional imaging module, the chassis assembly can be controlled to adjust the horizontal offset first, or the material box tray can be controlled to adjust the angle offset first, and there is no limitation here. Through the three-dimensional imaging module, the center of the retrieving and returning box assembly can be aligned with the center of the material box. Compared with the traditional method, labeling on the material box can be avoided, the alignment accuracy is improved, and the cost is reduced.
在实际的仓储环境中,还存在地面不平整或者料架安装误差等因素,为了精确定位每个料箱位,料架的每个料箱位均对应设置有二维的标识,该标识位于料箱位前侧横梁的中心位置。取还箱组件300上相应设置二维成像模组600,二维成像模组600被配置为用于获取料架上标识的位置信息。In the actual storage environment, there are factors such as uneven ground or installation errors of the material rack. In order to accurately locate each material box position, each material box position of the material The center position of the front beam of the box position. A two-dimensional imaging module 600 is correspondingly arranged on the take-and-return box assembly 300, and the two-dimensional imaging module 600 is configured to obtain the position information of the mark on the rack.
在本公开一个实施方式中,二维成像模组600可以为摄像头等,只要其能够获料架上标识的位置信息即可。二维成像模组600可以设置在取还箱组件300的基座360前端的中心位置。这有利于二维成像模组600读取其前方横梁上的标识的位置信息。In one embodiment of the present disclosure, the two-dimensional imaging module 600 may be a camera or the like, as long as it can obtain the position information marked on the rack. The two-dimensional imaging module 600 can be arranged at the center of the front end of the base 360 of the retrieval box assembly 300 . This facilitates the two-dimensional imaging module 600 to read the position information of the mark on the beam in front of it.
二维成像模组600获得横梁上标识的位置信息后,可以得到取还箱组件相对于料箱位的高度偏差和/或水平偏差。After the two-dimensional imaging module 600 obtains the position information marked on the beam, it can obtain the height deviation and/or horizontal deviation of the retrieval box assembly relative to the position of the material box.
具体地,控制单元获取基于二维成像模组600获得的标识位置后,对比分析取还箱组件300与标识的位置偏差,包括水平方向和竖直方向的偏差。控制单元被配置为基于二维成像模组600获得的与标识的位置偏差,控制底盘组件100在预定移动阈值范围内移动相应的距离;和/或控制取还箱组件300升降相应的高度。Specifically, after the control unit obtains the position of the mark based on the two-dimensional imaging module 600, it compares and analyzes the position deviation between the return box assembly 300 and the mark, including the deviation in the horizontal direction and the vertical direction. The control unit is configured to control the chassis assembly 100 to move a corresponding distance within a predetermined movement threshold range based on the positional deviation from the marker obtained by the two-dimensional imaging module 600; and/or control the return box assembly 300 to lift a corresponding height.
若取还箱组件300在水平方向上偏离标识,控制单元控制底盘组件100移动相应的距离,使取还箱组件300在水平方向上正对标识的位置。控制单元基于取还箱组件在高度方向上偏离,控制取还箱组件上下移动相应的距离,以调整取还箱组件300的高度,使取还箱组件300在竖直方向上正对标识的位置。由于受限于料箱周围的料架等障碍,需要设置底盘组件100移动的最大值,即在预定移动阈值范围内驱动底盘组件100移动相应的位移,以免调整过度而导致伸缩叉机构伸出时碰撞到周围的料架等障碍物。If the return box assembly 300 deviates from the mark in the horizontal direction, the control unit controls the chassis assembly 100 to move a corresponding distance, so that the return box assembly 300 faces the position of the mark in the horizontal direction. Based on the deviation of the return box assembly in the height direction, the control unit controls the return box assembly to move up and down a corresponding distance to adjust the height of the return box assembly 300, so that the return box assembly 300 is facing the position of the mark in the vertical direction . Due to the limitations of obstacles such as material racks around the material box, it is necessary to set the maximum value of the movement of the chassis assembly 100, that is, to drive the chassis assembly 100 to move a corresponding displacement within the predetermined movement threshold range, so as to avoid excessive adjustment and cause the extension of the telescopic fork mechanism. Collide with obstacles such as surrounding material racks.
本公开的二维成像模组可以与上述的三维成像模组配合使用,也可以独立使用。当与上述三维成像模组配合使用时,可以依靠三维成像模组实现取还箱组件与料箱之间的位置 角度偏差,以及中心的对准。可以依靠二维成像模组仅实现取还箱组件的高度精准定位,以弥补由于地面不平整、料架安装等因素所引起的高度偏差。当三维成像模组无法使用时,例如在送箱作业时,由于料箱位于料箱托盘中会阻挡三维成像模组,造成三维成像模组无法使用。此时可以使用二维成像模组与横梁上的标识,得到取还箱组件与标识中心的水平偏差和高度偏差,控制单元基于该水平偏差和高度偏差调整取还箱组件的水平偏移和高度偏移。The two-dimensional imaging module of the present disclosure can be used in conjunction with the above-mentioned three-dimensional imaging module, or can be used independently. When used in conjunction with the above-mentioned three-dimensional imaging module, the three-dimensional imaging module can be relied on to realize the position angle deviation between the retrieving and returning box assembly and the material box, as well as the alignment of the center. The two-dimensional imaging module can only be used to realize the highly accurate positioning of the take-and-return box components, so as to compensate for the height deviation caused by factors such as uneven ground and rack installation. When the 3D imaging module cannot be used, for example, during the box delivery operation, the 3D imaging module will be blocked because the material box is located in the material box tray, resulting in the 3D imaging module being unusable. At this time, the two-dimensional imaging module and the mark on the crossbeam can be used to obtain the horizontal deviation and height deviation between the return box assembly and the mark center, and the control unit adjusts the horizontal offset and height of the return box assembly based on the horizontal deviation and height deviation offset.
取箱步骤和送箱步骤有区别,这是由于搬运机器人是依靠伸缩叉机构将料箱勾取到料箱托盘上,以及将料箱托盘上的料箱推送到料架相应的料箱位上。因此在取料箱时,控制单元基于获取的标识位置,调整取还箱组件300升降至使料箱托盘330的承载面低于料架上用于放置料箱的承载面,以使料架位上的料箱能够顺利地移动至较低的料箱托盘330上。送料箱时,控制单元应当基于获取的标识位置,驱动取还箱组件300升降至使料箱托盘330的承载面高于料架上用于放置料箱的承载面,以使料箱托盘330上的料箱能够顺利的移动至较低的料箱位上。There is a difference between the box picking step and the box delivery step. This is because the handling robot relies on the telescopic fork mechanism to hook the material box onto the material box pallet, and push the material box on the material box pallet to the corresponding material box position on the material rack. . Therefore, when retrieving the material box, the control unit adjusts the lifting of the retrieving and returning box assembly 300 to make the bearing surface of the material box tray 330 lower than the bearing surface for placing the material box on the material rack based on the obtained identification position, so that the material rack is positioned The upper bins can be smoothly moved to the lower bin tray 330. When feeding the box, the control unit should drive the take-and-return box assembly 300 up and down based on the obtained identification position to make the bearing surface of the material box tray 330 higher than the bearing surface for placing the material box on the material rack, so that the loading surface of the material box tray 330 The material box can be smoothly moved to the lower position of the material box.
本申请还提供了一种基于上述搬运机器人的取送箱方法,包括取箱步骤和送箱步骤。取箱步骤和还箱步骤均包括以下步骤:The present application also provides a box picking method based on the above-mentioned handling robot, including a box picking step and a box sending step. Both the step of picking up the box and the step of returning the box include the following steps:
步骤S1000,控制取还箱组件300提升到目标高度;Step S1000, controlling the retrieval box assembly 300 to be lifted to the target height;
业务系统给搬运机器人下发取料箱或者送料箱的指令,搬运机器人接到业务指令后,基于其导航系统移动至目标(X,Y)位,并根据业务指令中包含的料箱位置信息,将取还箱组件提升到目标高度h。这些坐标信息均预先储存在业务系统中或者搬运机器人中,搬运器机器人根据这些位置信息便能做出相应的操作。The business system sends instructions to the handling robot to pick up or deliver boxes. After receiving the business order, the handling robot moves to the target (X, Y) position based on its navigation system, and according to the position information of the material box contained in the business order, Lift the return bin assembly to the target height h. These coordinate information are pre-stored in the business system or in the handling robot, and the handling robot can make corresponding operations based on the position information.
S2000,控制障碍物检测模组探测伸缩叉机构的伸出路径是否被遮挡;S2000, controlling the obstacle detection module to detect whether the extension path of the telescopic fork mechanism is blocked;
在伸缩叉机构伸出前,障碍物检测模组先探测伸缩叉机构的伸出路径是否被遮挡。例如可通过激光传感器沿着伸缩叉机构的伸出路径发射激光,如果激光在其探测距离中被遮挡,则激光传感器会被触发,由此可认为伸缩叉机构的伸出路径被遮挡。如果此时伸缩叉机构伸出,则会与其前方的障碍物发生碰撞。Before the extension of the telescopic fork mechanism, the obstacle detection module first detects whether the extension path of the telescopic fork mechanism is blocked. For example, the laser sensor can emit a laser light along the extension path of the telescopic fork mechanism. If the laser light is blocked in its detection range, the laser sensor will be triggered, so that it can be assumed that the extension path of the telescopic fork mechanism is blocked. If the telescopic fork mechanism is stretched out at this time, it will collide with the obstacle in front of it.
结合到某一具体应用场景中,搬运机器人的伸缩叉机构包括第一伸缩臂310、第二伸缩臂320,障碍物检测模组包括用于检测第一伸缩臂310伸出路径是否被遮挡的第一障碍物检测模组410,及用于检测第二伸缩臂320伸出路径是否被遮挡的第二障碍物检测模组420;Combined with a specific application scenario, the telescopic fork mechanism of the handling robot includes a first telescopic arm 310 and a second telescopic arm 320, and the obstacle detection module includes a first telescopic arm 310 for detecting whether the extending path is blocked. An obstacle detection module 410, and a second obstacle detection module 420 for detecting whether the extending path of the second telescopic arm 320 is blocked;
步骤S2000包括:Step S2000 includes:
S2100,控制第一障碍物检测模组410、第二障碍物检测模组420分别检测第一伸缩臂310、第二伸缩臂320的伸出路径是否被遮挡;S2100, controlling the first obstacle detection module 410 and the second obstacle detection module 420 to detect whether the extending paths of the first telescopic arm 310 and the second telescopic arm 320 are blocked;
第一障碍物检测模组410用于检测第一伸缩臂的伸出路径是否被遮挡,第二障碍物检测模组420用于检测第二伸缩臂的伸出路径是否被遮挡。The first obstacle detection module 410 is used to detect whether the extension path of the first telescopic arm is blocked, and the second obstacle detection module 420 is used to detect whether the extension path of the second telescopic arm is blocked.
S2200,响应于第一障碍物检测模组410、第二障碍物检测模组420中的其中一个检测到相应的伸出路径被遮挡,控制搬运机器人向被遮挡的一侧移动,直到该侧不被遮挡;S2200, in response to one of the first obstacle detection module 410 and the second obstacle detection module 420 detecting that the corresponding extension path is blocked, control the handling robot to move to the blocked side until the side is not closed blocked
控制单元接收第一障碍物检测模组410、第二障碍物检测模组420的信号,如果检测到其中一个伸缩臂的伸出路径被遮挡时,控制单元发出控制指令,驱动搬运机器人的底盘组件向该被遮挡的一侧移动,直到该侧伸缩臂移动到离开障碍物。在此需要注意的是,在控制底盘组件进行移动时,两个伸缩臂是同步运动的,因此在控制底盘组件进行移动时,最终要保证两侧伸缩臂的伸出路径均未被遮挡。这可以通过两个障碍物检测模组的多次检测来实现,在此不再具体说明。The control unit receives signals from the first obstacle detection module 410 and the second obstacle detection module 420, and if it detects that the extension path of one of the telescopic arms is blocked, the control unit sends a control command to drive the chassis assembly of the transport robot Move towards the blocked side until the side telescoping arm moves clear of the obstruction. It should be noted here that when the chassis assembly is controlled to move, the two telescopic arms move synchronously. Therefore, when the chassis assembly is controlled to move, it is ultimately necessary to ensure that the extension paths of the telescopic arms on both sides are not blocked. This can be achieved through multiple detections by two obstacle detection modules, which will not be described in detail here.
另外,为了保证搬运机器人的运行安全,需要设置最大移动距离,即位移调整范围,如果在该最大移动距离范围内依然存在某侧伸缩臂的伸出路径被遮挡,则机器人停止移动,向系统上报异常。In addition, in order to ensure the safe operation of the handling robot, it is necessary to set the maximum moving distance, that is, the displacement adjustment range. If the extension path of the telescopic arm on one side is still blocked within the maximum moving distance range, the robot will stop moving and report to the system. abnormal.
S2300,响应于第一障碍物检测模组410、第二障碍物检测模组420检测到相应的伸出 路径均被遮挡,发出停止取料箱指令,并上报异常。S2300, in response to the first obstacle detection module 410 and the second obstacle detection module 420 detecting that the corresponding extension paths are blocked, issue a command to stop the retrieving box, and report an exception.
当两个障碍物检测模组检测各自伸缩臂的伸出路径均被遮挡,则无法再通过移动来进行调整,此时可发出停止取料箱指令,并将该异常上报给业务系统。When the two obstacle detection modules detect that the extension paths of their respective telescopic arms are blocked, they can no longer be adjusted by moving. At this time, an instruction to stop the retrieving box can be issued and the abnormality can be reported to the business system.
在本公开的该实施例中,若第一障碍物检测模组410、第二障碍物检测模组420中的其中一个检测到相应的伸出路径被遮挡,则可能是伸缩叉机构与料箱位置偏离造成的,通过调整伸缩叉机构的位置,能够消除相应的伸出路径被遮挡的问题。若第一障碍物检测模组410、第二障碍物检测模组420检测到相应的伸出路径均被遮挡,则可能是料箱附近存在其他障碍物或者是料箱严重偏移,此时通过调整伸缩叉机构的位置难以消除相应的伸出路径被遮挡的问题,因此机器人应当发出停止取料箱指令,并上报异常。In this embodiment of the present disclosure, if one of the first obstacle detection module 410 and the second obstacle detection module 420 detects that the corresponding extension path is blocked, it may be that the telescopic fork mechanism and the material box Due to position deviation, by adjusting the position of the telescopic fork mechanism, the problem that the corresponding extension path is blocked can be eliminated. If the first obstacle detection module 410 and the second obstacle detection module 420 detect that the corresponding extension path is blocked, it may be that there are other obstacles near the material box or the material box is seriously offset. Adjusting the position of the telescopic fork mechanism is difficult to eliminate the problem that the corresponding extension path is blocked, so the robot should issue a command to stop the retrieving box and report an exception.
S3000,响应于障碍物检测模组检测到伸出路径未被遮挡,控制伸缩叉机构伸出。S3000, in response to the obstacle detection module detecting that the extending path is not blocked, controlling the telescopic fork mechanism to extend.
当障碍物检测模组未检测到伸缩叉机构的伸出路径被遮挡时,则可以控制伸缩叉机构伸出。应用到上述的场景中,即当第一障碍物检测模组410、第二障碍物检测模组420检测相应侧的伸出路径均未被遮挡,则可以控制第一伸缩臂、第二伸缩臂伸出,以实现取料箱或者还料箱。When the obstacle detection module does not detect that the extension path of the telescopic fork mechanism is blocked, it can control the extension of the telescopic fork mechanism. Applied to the above scenario, that is, when the first obstacle detection module 410 and the second obstacle detection module 420 detect that the extension paths on the corresponding sides are not blocked, the first telescopic arm and the second telescopic arm can be controlled Stretch out to realize the retrieving box or the material returning box.
在本公开一个实施方式上,上述步骤S2000,以及步骤S2100、步骤S2200、步骤S2300是在伸缩叉机构的第一伸缩臂、第二伸缩臂未伸出之前进行的。而在步骤S3000之后,伸缩叉机构在伸出的过程中,控制第一障碍物检测模组410、第二障碍物检测模组420实时检测,如果探测的某一侧或者两侧的伸出路径被遮挡,则控制伸缩叉机构停止向前伸出,并上报异常。机器人可以放弃此次取送箱步骤,并等待系统分配其它任务。In one embodiment of the present disclosure, the above step S2000, and steps S2100, S2200, and S2300 are performed before the first telescopic arm and the second telescopic arm of the telescopic fork mechanism are not stretched out. After step S3000, the telescopic fork mechanism controls the first obstacle detection module 410 and the second obstacle detection module 420 to detect in real time during the extension process. If it is blocked, the telescopic fork mechanism is controlled to stop extending forward, and an abnormality is reported. The robot can give up the step of picking up and delivering boxes, and wait for the system to assign other tasks.
在伸缩叉机构伸出的过程中,可能突然发生伸缩叉机构的伸出路径上出现障碍物的情况,比如障碍物检测模组在伸缩叉机构伸出之前未能检测到障碍物的情况,或者料箱在伸缩叉机构伸出的过程中突然出现移动等情况。本方法中,障碍物检测模组实时检测伸缩叉机构的伸出路径是否被遮挡,并且在检测到伸出路径被遮挡时,控制单元控制伸缩叉机构及时停止运动,能够进一步确保取箱过程中的安全性。During the extension process of the telescopic fork mechanism, an obstacle may suddenly appear on the extension path of the telescopic fork mechanism, for example, the obstacle detection module fails to detect the obstacle before the telescopic fork mechanism is extended, or The material box suddenly moves when the telescopic fork mechanism is extended. In this method, the obstacle detection module detects in real time whether the extension path of the telescopic fork mechanism is blocked, and when it detects that the extension path is blocked, the control unit controls the telescopic fork mechanism to stop in time, which can further ensure security.
在本公开取送箱的一个实施方式中,在步骤S1000之后,还包括:In one embodiment of the delivery box of the present disclosure, after step S1000, it also includes:
二维成像模组600检测对应料架横梁上的标识的位置偏差,以及基于该位置偏差控制搬运机器人在预定移动阈值范围内移动相应的距离;和/或控制取还箱组件300升降相应的高度。The two-dimensional imaging module 600 detects the positional deviation of the mark on the beam corresponding to the shelf, and based on the positional deviation, controls the handling robot to move a corresponding distance within a predetermined movement threshold; and/or controls the retrieving and returning box assembly 300 to rise and fall to a corresponding height .
搬运机器人的二维成像模组600通过料架上的标识来确定料箱位的准确位置,并且基于检测到的与标识的相对位置偏差,控制底盘组件100在预定移动阈值范围内移动相应的距离,调整水平方向的位置,并控制升降组件上下移动,调整取还箱组件300竖直方向的位置,从而提高取还箱组件300相对料箱位的位置精度。The two-dimensional imaging module 600 of the handling robot determines the exact position of the bin position through the marking on the material rack, and based on the detected relative position deviation from the marking, controls the chassis assembly 100 to move a corresponding distance within a predetermined movement threshold range , adjust the position in the horizontal direction, and control the lifting assembly to move up and down, adjust the vertical position of the retrieving and returning box assembly 300, thereby improving the position accuracy of the retrieving and returning box assembly 300 relative to the position of the material box.
通过二维成像模组600来检测取还箱组件与料架横梁上标识的位置偏差,并以此来调整取还箱组件的相对位置,可弥补由于地面不平、料架安装精度低或者其它因素所带来的位置偏差。Use the two-dimensional imaging module 600 to detect the positional deviation between the retrieval box assembly and the mark on the rack beam, and use this to adjust the relative position of the retrieval box assembly, which can compensate for uneven ground, low installation accuracy of the material rack, or other factors resulting positional deviation.
取料箱时,为了使料架上的料箱能够顺利地移动至较低的料箱托盘330上,控制单元驱动取还箱组件300升降至使料箱托盘330的承载面低于料架上用于放置料箱的承载面。送料箱时,为了使料箱托盘330上的料箱能够顺利的移动至较低的料架位上,控制单元驱动取还箱组件300升降至使料箱托盘330的承载面高于料架上用于放置料箱的承载面。When retrieving the material box, in order to enable the material box on the material rack to move smoothly to the lower material box tray 330, the control unit drives the retrieving and returning box assembly 300 to lift to make the bearing surface of the material box tray 330 lower than the material shelf The load-bearing surface for placing the container. When feeding boxes, in order to enable the boxes on the box tray 330 to move smoothly to a lower shelf position, the control unit drives the retrieval box assembly 300 to lift to make the bearing surface of the box tray 330 higher than the shelf The load-bearing surface for placing the container.
在取箱步骤中,在步骤S1000之后,还包括:In the box-taking step, after step S1000, it also includes:
三维成像模组500检测对应料架上料箱的位置偏差,以及基于该位置偏差控制搬运机器人在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘330在预定转动阈值范围内转动相应的角度。The three-dimensional imaging module 500 detects the position deviation of the bin on the corresponding rack, and based on the position deviation controls the handling robot to move a corresponding distance within a predetermined movement threshold range; and/or controls the bin tray 330 within a predetermined rotation threshold range Rotate the corresponding angle.
由于三维成像模组500可以检测料箱的三维位置信息,由此可以基于三维位置偏差,调整取还箱组件的中心与料箱的中心对准。这种调整包括水平移动、竖直方向移动以及旋转角度等。当然,该三维成像模组500与二维成像模组600配合使用时,可以预先通过二 维成像模组600调整取还箱组件的高度偏移,通过三维成像模组500调整水平偏移和角度偏移。这是由于二维成像模组600检测的是料架横梁上的标识,而三维成像模组500检测的对象为料箱位上的料箱。Since the three-dimensional imaging module 500 can detect the three-dimensional position information of the material box, it can adjust the alignment between the center of the retrieval box assembly and the center of the material box based on the three-dimensional position deviation. This adjustment includes horizontal movement, vertical movement and rotation angle, etc. Of course, when the three-dimensional imaging module 500 is used in conjunction with the two-dimensional imaging module 600, the height offset of the retrieving and returning box assembly can be adjusted through the two-dimensional imaging module 600 in advance, and the horizontal offset and angle can be adjusted through the three-dimensional imaging module 500 offset. This is because what the 2D imaging module 600 detects is the mark on the crossbeam of the rack, while the object detected by the 3D imaging module 500 is the bin on the bin position.
搬运机器人基于二维成像模组600检测的标识的位置偏差进行位置调整后,能够提高取还箱组件300相对料箱位的位置精度,但依然不能保证取还箱组件300能够对准料箱,因此还需要通过三维成像模组500检测取还箱组件300与料箱间的相对位置,包括料箱位置与取还箱组件之间是否有水平偏移,以及料箱与伸缩叉机构是否有角度偏移。After the handling robot adjusts the position based on the position deviation of the mark detected by the two-dimensional imaging module 600, the position accuracy of the retrieving and returning box assembly 300 relative to the position of the material box can be improved, but it still cannot guarantee that the retrieving and returning box assembly 300 can be aligned with the material box. Therefore, it is also necessary to use the 3D imaging module 500 to detect the relative position between the retrieving and returning box assembly 300 and the material box, including whether there is a horizontal offset between the position of the material box and the retrieving and returning box assembly, and whether there is an angle between the material box and the telescopic fork mechanism offset.
在上述的取送箱方法中,搬运机器人通过二维成像模组、障碍物检测模以及三维成像模组500对料箱进行了准确的定位,并根据料箱位置对取还箱组件300的位置进行了调整,提高了取箱准确性,同时极大的提高了取箱过程的自动化和安全性。In the above method for picking up and delivering boxes, the handling robot accurately positions the box through the two-dimensional imaging module, the obstacle detection module, and the three-dimensional imaging module 500, and determines the position of the box assembly 300 according to the position of the box. Adjustments have been made to improve the accuracy of box picking, and at the same time greatly improve the automation and safety of the box picking process.
本申请在以下实施例中提供一种取还箱方法,其可以应用到搬运机器人中,包括以下步骤:The present application provides a method for retrieving and returning boxes in the following embodiments, which can be applied to a handling robot, including the following steps:
S1000′,控制取还箱组件按照系统内预存的目标箱位的高度值提升到目标高度。S1000', controlling the retrieving and returning box assembly to lift to the target height according to the height value of the target box position prestored in the system.
业务系统给搬运机器人下发取料箱或者送料箱的指令,搬运机器人接到业务指令后,基于其导航系统移动至目标(X,Y)位,并根据业务指令中包含的目标箱位的高度位置信息,将取还箱组件提升到目标高度h。这些坐标信息均预先储存在业务系统中,搬运器机器人根据这些位置信息便能做出相应的操作。The business system sends instructions to the handling robot to pick up or deliver boxes. After receiving the business order, the handling robot moves to the target (X, Y) position based on its navigation system, and according to the height of the target box contained in the business order Position information, lift the return box assembly to the target height h. These coordinate information are pre-stored in the business system, and the carrier robot can make corresponding operations based on the position information.
S2000′,基于二维成像模组获得的目标箱位标识的位置,得到取还箱组件与标识之间的高度位置偏差;S2000', based on the position of the target box mark obtained by the two-dimensional imaging module, obtain the height position deviation between the retrieving box component and the mark;
料架上每个箱位前面的横梁上均设置有二维标识,该二维标识可以用来对搬运机器人的位置进行精准定位。取还箱组件按照系统预存的参数提升到目标高度后,可通过二维成像模组获取与目标箱位对应横梁上标识的位置信息,基于该标识的位置信息便可得到取还箱组件与该标识位置的高度位置偏差,该高度位置偏差例如指示了取还箱组件相对于标识所在高度间的具体差值。There is a two-dimensional mark on the beam in front of each box position on the material rack, and the two-dimensional mark can be used to accurately locate the position of the handling robot. After the return box component is lifted to the target height according to the parameters prestored in the system, the position information of the mark on the beam corresponding to the target box position can be obtained through the two-dimensional imaging module. Based on the position information of the mark, the return box component and the The height position deviation of the marking position, the height position deviation indicates, for example, a specific difference between the heights of the return box assembly relative to the marking.
S3000′,在取箱步骤中,基于获得的所述高度位置偏差,控制所述取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面。S3000', in the box taking step, based on the obtained height position deviation, control the take-and-return box assembly to lift so that the bearing surface of the material box tray is lower than the bearing surface for placing material boxes on the material rack.
在取箱步骤中,通常是取还箱组件中的第一伸缩臂、第二伸缩臂伸向料架上目标箱位的位置,将位于目标箱位上的料箱直接勾取到取还箱组件的料箱托盘上。因此,在该步骤中,基于获得的所述高度位置偏差,控制取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面,这样可使料箱能够从较高的目标箱位上顺利地移动至较低的料箱托盘上。In the box retrieval step, usually the first telescopic arm and the second telescopic arm in the box retrieval assembly extend to the position of the target box position on the material shelf, and directly hook the material box located on the target box position to the retrieval box components on the bin pallet. Therefore, in this step, based on the obtained height position deviation, control the lifting of the retrieving box assembly to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack, so that the material box can be placed Smooth movement from higher target bins to lower bin pallets.
S4000′,在送箱步骤中,驱动所述取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面。S4000', in the box sending step, drive the take-and-return box assembly to lift to make the bearing surface of the material box tray higher than the bearing surface for placing material boxes on the material rack.
在送箱步骤中,通常是取还箱组件中的第一伸缩臂、第二伸缩臂将位于料箱托盘上的料箱推动到料架的目标箱位上。因此,在该步骤中,基于获得的所述高度位置偏差,控制取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面,这样可使料箱能够从较高的料箱托盘上顺利地移动至较低的目标箱位上。In the box delivery step, usually the first telescopic arm and the second telescopic arm in the box assembly push the box on the box tray to the target box position on the shelf. Therefore, in this step, based on the obtained height position deviation, control the lifting of the retrieving box assembly to make the bearing surface of the material box tray higher than the bearing surface for placing the material box on the material rack, so that the material box can be placed Move smoothly from higher bin pallets to lower destination bins.
在上述实施例中,搬运机器人可以包括底盘组件、门架组件、取还箱组件,也可以是采用上述包括障碍物检测模组的搬运机器人。由此在该实施例中,还可以适应于上述关于障碍物检测模组的步骤,在此不再具体说明。In the above embodiments, the transport robot may include a chassis assembly, a door frame assembly, and a retrieving box assembly, or it may be a transport robot using the above-mentioned obstacle detection module. Therefore, in this embodiment, it can also be adapted to the above-mentioned steps related to the obstacle detection module, which will not be described in detail here.
在本申请一个实施例中,至少在所述送箱步骤中,还基于二维成像模组获得的目标箱位标识的位置,得到取还箱组件与标识之间的水平位置偏差;基于获得的所述水平位置偏差,控制底盘组件移动以调整取还箱组件的水平位移。In one embodiment of the present application, at least in the box sending step, based on the position of the target box location mark obtained by the two-dimensional imaging module, the horizontal position deviation between the return box assembly and the mark is obtained; based on the obtained The horizontal position deviation controls the movement of the chassis assembly to adjust the horizontal displacement of the retrieval box assembly.
在送箱步骤中,由于料箱托盘中放置了料箱,因此很难在料箱托盘上设置其它检测模组来检测搬运机器人与目标箱位之间的位置偏差,因此可通过二维成像模组获取与目标箱位对应横梁上标识的位置信息,基于该标识的位置信息便可得到取还箱组件与该标识位置 的水平位置偏差,该水平位置偏差例如指示了取还箱组件相对于标识所在位置间的水平差值。In the box delivery step, since the boxes are placed on the box tray, it is difficult to install other detection modules on the box tray to detect the position deviation between the handling robot and the target box position, so the two-dimensional imaging module can The group obtains the position information of the mark on the crossbeam corresponding to the target box location, and based on the position information of the mark, the horizontal position deviation between the return box component and the position of the mark can be obtained. The horizontal difference between the locations.
基于获得的水平位置偏差,由此可控制底盘组件移动相应的位移,以调整取还箱组件的水平位置,例如可以调整至使取还箱组件的中心与标识的中心位置对齐。Based on the obtained horizontal position deviation, the chassis assembly can be controlled to move a corresponding displacement to adjust the horizontal position of the return box assembly, for example, it can be adjusted to align the center of the return box assembly with the center position of the mark.
在该实施例中,可以基于二维成像模组获取的标识位置,同时得到取还箱组件与标识间的高度位置偏差和水平位置偏差。也可以是先获得高度位置偏差并调整取还箱组件的高度位置后,再识别一次标识位置,并基于识别得到的水平位置偏差调整取还箱组件的水平位置,反之亦然,在此不做具体说明。In this embodiment, the height position deviation and the horizontal position deviation between the retrieval box assembly and the sign can be simultaneously obtained based on the sign position acquired by the two-dimensional imaging module. It is also possible to first obtain the height position deviation and adjust the height position of the return box assembly, then identify the marking position again, and adjust the horizontal position of the return box assembly based on the recognized horizontal position deviation, and vice versa, which is not done here Be specific.
在本申请一个实施例中,在所述取箱步骤中,还包括:In one embodiment of the present application, in the step of taking out the box, it also includes:
基于三维成像模组获取料箱的三维信息,得到取还箱组件与料箱之间的位置偏差;Obtain the three-dimensional information of the material box based on the three-dimensional imaging module, and obtain the position deviation between the retrieval box component and the material box;
控制底盘组件在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度。三维成像模组可以是深度相机或全景相机,也可以为多个相机的组合,只要其能够获取料箱的三维成像信息即可。三维成像模组能够将其获取的三维位置信息发送至控制单元。Controlling the chassis assembly to move a corresponding distance within a predetermined movement threshold range; and/or controlling the bin tray to rotate a corresponding angle within a predetermined rotation threshold range. The 3D imaging module can be a depth camera or a panoramic camera, or a combination of multiple cameras, as long as it can obtain the 3D imaging information of the material box. The 3D imaging module can send the acquired 3D position information to the control unit.
在该步骤中,通过三维成像模组获取目标箱位上料箱的三维信息,并基于料箱的三维信息得到取还箱组件与料箱的相对角度偏差和/或水平位置偏差。In this step, the three-dimensional information of the bins at the target bin location is obtained through the three-dimensional imaging module, and the relative angular deviation and/or horizontal position deviation between the retrieving bin assembly and the bins is obtained based on the three-dimensional information of the bins.
由此可以基于取还箱组件与料箱的相对角度偏差和/或水平位移偏差,调整取还箱组件与料箱间的相对角度,例如调整至使取还箱组件的两个伸缩臂与料箱相对两侧的侧壁平行。和/或,控制底盘组件水平移动,以达到调整取还箱组件水平位置偏差的问题。Therefore, the relative angle between the retrieval box assembly and the material box can be adjusted based on the relative angular deviation and/or horizontal displacement deviation between the retrieval box assembly and the material box, for example, adjusted so that the two telescopic arms of the retrieval box assembly are aligned with the material box. The side walls on opposite sides of the box are parallel. And/or, control the horizontal movement of the chassis assembly to achieve the problem of adjusting the horizontal position deviation of the return box assembly.
本申请在以下实施例中提供一种取箱的具体方法,包括以下步骤:The present application provides a specific method for taking out boxes in the following embodiments, including the following steps:
步骤S1、搬运机器人行走至目标位置,控制取还箱组件300提升至目标高度;Step S1, the transport robot walks to the target position, and controls the take-and-return box assembly 300 to lift to the target height;
业务系统给搬运机器人下发取料箱的指令,搬运机器人接到业务指令后,基于其导航系统移动至目标(X,Y)位,并根据业务指令中包含的料箱位置信息,将取还箱组件提升到目标高度h。这些坐标信息均预先储存在业务系统中或者搬运机器人中,搬运器机器人根据这些位置信息便能做出相应的操作。The business system sends an order to the handling robot to pick up the material box. After the handling robot receives the business order, it moves to the target (X, Y) position based on its navigation system, and according to the position information of the material box contained in the business order, it will pick up and return The box assembly is lifted to the target height h. These coordinate information are pre-stored in the business system or in the handling robot, and the handling robot can make corresponding operations based on the position information.
步骤S2、通过二维成像模组获取料架横梁上标识的位置信息,并基于得到的取还箱组件300的位置偏差调整所述取还箱组件300的位置;Step S2: Obtain the position information marked on the crossbeam of the rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly 300 based on the obtained position deviation of the retrieval box assembly 300;
在步骤S2中,具体基于取还箱组件300的高度位置偏差调整所述取还箱组件300的高度,对取还箱组件300进行高度精准定位,弥补由于地面不平、料架安装精度低或其它原因造成的高度误差。在该实施例中,调整取还箱组件的位置,使得料箱托盘330的承载面低于料架上用于放置料箱的承载面。In step S2, the height of the take-and-return box assembly 300 is adjusted based on the height position deviation of the take-and-return box assembly 300, and the height of the take-and-return box assembly 300 is precisely positioned to compensate for uneven ground, low rack installation accuracy or other The height error caused by the cause. In this embodiment, the position of the retrieving and returning box assembly is adjusted so that the bearing surface of the material box tray 330 is lower than the bearing surface for placing material boxes on the material shelf.
步骤S3、通过障碍物检测模组分别检测第一伸缩臂310、第二伸缩臂320前方的伸出路径是否被遮挡,Step S3, through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm 310 and the second telescopic arm 320 are blocked,
若检测到第一伸缩臂310、第二伸缩臂320的伸出路径均被遮挡,则停止取箱,上报异常信息。机器人可以停止该次取箱任务,等待系统分配任务;If it is detected that the extension paths of the first telescopic arm 310 and the second telescopic arm 320 are blocked, then stop picking up boxes and report abnormal information. The robot can stop the box picking task and wait for the system to assign the task;
若单侧被遮挡,则控制搬运机器人向被遮挡一侧调整位置至两侧的伸出路径均未被遮挡,然后进行步骤S4;在该步骤中,设置最大调整阈值,这样可以避免因调整过大撞到挨着的货箱或者货架立柱;If one side is blocked, then control the handling robot to adjust its position to the blocked side until the stretching paths on both sides are not blocked, and then proceed to step S4; in this step, set the maximum adjustment threshold, so as to avoid Bump into adjacent cargo boxes or shelf columns;
若两侧均无遮挡,则进行步骤S4;If there is no occlusion on both sides, proceed to step S4;
步骤S4、基于三维成像模组500获取料箱的三维信息,获得取还箱组件300与料箱之间的位置偏差;Step S4, based on the three-dimensional imaging module 500, obtain the three-dimensional information of the material box, and obtain the positional deviation between the retrieving and returning box assembly 300 and the material box;
若取还箱组件300与料箱的位置间存在偏差此时应当认定需要对取还箱组件300的位置进行调整。控制搬运机器人在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘330在预定转动阈值范围内转动相应的角度;然后执行步骤S5;If there is a deviation between the positions of the retrieval box assembly 300 and the material box, it should be determined that the position of the retrieval box assembly 300 needs to be adjusted. Control the handling robot to move a corresponding distance within a predetermined movement threshold; and/or control the bin tray 330 to rotate a corresponding angle within a predetermined rotation threshold; then execute step S5;
在该步骤中,通过三维成像模组500识别到的取还箱组件与料箱的相对角度偏差,驱动料箱托盘转动至使其与料箱一致。通过三维成像模组500识别到的取还箱组件与料箱的 横向或水平偏移,驱动底盘组件运动至使取还箱组件的中心和料箱的中心对齐。In this step, based on the relative angular deviation between the retrieval box assembly and the material box identified by the 3D imaging module 500, the material box tray is driven to rotate to make it consistent with the material box. The lateral or horizontal offset between the retrieval box assembly and the material box identified by the three-dimensional imaging module 500 drives the chassis assembly to move to align the center of the retrieval box assembly with the center of the material box.
在该实施例中,如果取还箱组件300与料箱间的偏差在可允许的范围内,则不需要调整,可以直接执行步骤S5。如果取还箱组件300与料箱间的偏差在可允许的范围外,此时应当认定需要对取还箱组件300的位置进行调整。In this embodiment, if the deviation between the retrieval box assembly 300 and the material box is within the allowable range, no adjustment is required, and step S5 can be directly performed. If the deviation between the retrieving bin assembly 300 and the material bin is outside the allowable range, it should be determined that the position of the retrieving bin assembly 300 needs to be adjusted at this time.
也可以是,如果取还箱组件300与料箱间的偏差在可允许的范围内,则调整取还箱组件300两侧的伸缩臂与料箱的侧壁平行后,直接执行步骤S5。如果取还箱组件300与料箱间的偏差在可允许的范围外时,调整取还箱组件300两侧的伸缩臂与料箱的侧壁平行后,再执行步骤S4进行检查。Alternatively, if the deviation between the retrieval box assembly 300 and the material box is within the allowable range, step S5 is directly performed after adjusting the telescopic arms on both sides of the retrieval box assembly 300 to be parallel to the side walls of the material box. If the deviation between the retrieval box assembly 300 and the material box is outside the allowable range, adjust the telescopic arms on both sides of the retrieval box assembly 300 to be parallel to the side walls of the material box, and then perform step S4 to check.
步骤S5、控制取还箱组件300伸出。Step S5, controlling the retrieval box assembly 300 to extend out.
取还箱组件300的第一伸缩臂、第二伸缩臂在伸出的过程中,第一障碍物检测模组410、第二障碍物检测模组420实时检测相应侧的前方是否被遮挡,遇到障碍物时则控制伸缩臂停止运动。When the first telescopic arm and the second telescopic arm of the retrieval box assembly 300 are extended, the first obstacle detection module 410 and the second obstacle detection module 420 detect in real time whether the front of the corresponding side is blocked. When reaching an obstacle, the telescopic arm is controlled to stop moving.
本申请在以下实施例中还提供了一种取箱方法,应用于搬运机器人,其包括以下步骤:The present application also provides a box picking method in the following embodiments, which is applied to a handling robot, which includes the following steps:
步骤S100,控制取还箱组件提升到目标高度;Step S100, controlling the take-and-return box assembly to be lifted to the target height;
业务系统给搬运机器人下发取料箱或者送料箱的指令,搬运机器人接到业务指令后,基于其导航系统移动至目标(X,Y)位,并根据业务指令中包含的目标箱位的高度位置信息,将取还箱组件提升到目标高度h。这些坐标信息均预先储存在业务系统中,搬运器机器人根据这些位置信息便能做出相应的操作。The business system sends instructions to the handling robot to pick up or deliver boxes. After receiving the business order, the handling robot moves to the target (X, Y) position based on its navigation system, and according to the height of the target box contained in the business order Position information, lift the return box assembly to the target height h. These coordinate information are pre-stored in the business system, and the carrier robot can make corresponding operations based on the position information.
步骤S200,基于三维成像模组获取料箱的三维信息,得到取还箱组件与料箱之间的位置偏差。In step S200, the three-dimensional information of the material box is obtained based on the three-dimensional imaging module, and the positional deviation between the retrieving and returning box assembly and the material box is obtained.
三维成像模组可以是深度相机或全景相机,也可以为多个相机的组合,只要其能够获取料箱的三维成像信息即可。三维成像模组能够将其获取的三维位置信息发送至控制单元。The 3D imaging module can be a depth camera or a panoramic camera, or a combination of multiple cameras, as long as it can obtain the 3D imaging information of the material box. The 3D imaging module can send the acquired 3D position information to the control unit.
三维成像模组获得其前方料箱的三维位置后,可以得到料箱与三维成像模组或取还箱组件间的三维偏差,这包括了位移偏差和角度偏差。例如,可以计算料箱前侧若干个点的距离信息,并根据该距离信息判断料箱偏转的角度。再例如,深度相机获得料箱的图像后,可以分析料箱的中心与取还箱组件中心之间的偏差,以此作为料箱水平、高度偏移的距离等。这种通过深度相机获得料箱图像,并判断料箱位置偏差的技术属于本领域技术人员的公知常识,在此不再具体说明。After the 3D imaging module obtains the 3D position of the material box in front of it, it can obtain the 3D deviation between the material box and the 3D imaging module or the retrieval box assembly, which includes displacement deviation and angle deviation. For example, the distance information of several points on the front side of the material box can be calculated, and the deflection angle of the material box can be judged according to the distance information. For another example, after the depth camera obtains the image of the material box, it can analyze the deviation between the center of the material box and the center of the return box assembly, and use it as the distance of the level and height of the material box. The technology of obtaining the image of the material box through the depth camera and judging the position deviation of the material box belongs to the common knowledge of those skilled in the art, and will not be described in detail here.
步骤S300,控制底盘组件移动相应的距离;和/或,控制料箱托盘转动相应的角度。Step S300, controlling the chassis assembly to move a corresponding distance; and/or controlling the bin tray to rotate a corresponding angle.
在本公开一个实施方式中,控制单元基于得到的料箱与取还箱组件之间的水平偏差,控制底盘组件向预定的方向移动相应的距离。由于三维成像模组获得的是料箱的三维位置信息,因此可得到其与料箱间水平偏移的距离,控制单元基于该水平偏移量可直接驱动底盘组件向预定的方向移动相应的距离,来消除取还箱组件与料箱在水平位移上的偏差。In one embodiment of the present disclosure, the control unit controls the chassis assembly to move a corresponding distance in a predetermined direction based on the obtained horizontal deviation between the material box and the retrieval box assembly. Since the three-dimensional imaging module obtains the three-dimensional position information of the material box, it can obtain the horizontal offset distance between it and the material box, and the control unit can directly drive the chassis assembly to move a corresponding distance in a predetermined direction based on the horizontal offset , to eliminate the deviation of the horizontal displacement between the retrieval box assembly and the material box.
在本公开一个实施方式中,控制单元基于得到的料箱与取还箱组件之间的高度偏差,控制取还箱组件升降至合适的位置。由于三维成像模组获得的是料箱的三维位置信息,因此可得到其与料箱间高度偏移的距离,控制单元基于该高度偏移量可驱动取还箱组件在高度方向上移动相应的距离,来消除取还箱组件与料箱在高度方向上的偏差。In one embodiment of the present disclosure, the control unit controls the lifting of the retrieving bin assembly to a proper position based on the obtained height deviation between the material bin and the retrieving bin assembly. Since the 3D imaging module obtains the 3D position information of the material box, it can obtain the height offset distance between it and the material box. Based on the height offset, the control unit can drive the retrieving box assembly to move the corresponding distance to eliminate the deviation in the height direction between the retrieval box assembly and the material box.
在该实施例中,例如可以控制取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面,这样可使料箱能够从较高的目标箱位上顺利地移动至较低的料箱托盘上。In this embodiment, for example, the take-and-return box assembly can be controlled to lift to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack, so that the material box can be lifted from a higher target box position. Moves smoothly onto the lower bin pallet.
在本公开一个实施方式中,控制单元基于得到的料箱与取还箱组件之间的角度偏差,控制取还箱组件转动相应的角度。由于三维成像模组获得的是料箱的三维位置信息,由此可得到料箱具体的偏移角度,控制单元基于该偏移角度可直接驱动取还箱组件中的料箱托盘向预定的方向转动相应的角度。In one embodiment of the present disclosure, the control unit controls the retrieving box assembly to rotate by a corresponding angle based on the obtained angle deviation between the material box and the retrieving box assembly. Since the three-dimensional imaging module obtains the three-dimensional position information of the material box, the specific offset angle of the material box can be obtained, and the control unit can directly drive the material box pallet in the retrieval box assembly to a predetermined direction based on the offset angle Rotate the corresponding angle.
在上面描述的实施例中,基于水平偏移、高度偏移、角度偏移来实现相应调整的功能可以是任意的,例如仅实现基于水平偏移的调整,或仅实现基于高度偏移的调整,或仅实 现基于角度偏移的调整;也可以是任意的组合,例如基于水平偏移、角度偏移来调整水平位置及角度位置,或者是其它,在此不再具体说明。In the embodiments described above, the corresponding adjustment function based on horizontal offset, height offset, and angle offset can be arbitrary, such as only adjusting based on horizontal offset, or only adjusting based on height offset , or only realize the adjustment based on the angle offset; it can also be any combination, such as adjusting the horizontal position and the angle position based on the horizontal offset and the angle offset, or others, which will not be described in detail here.
在基于三维成像模组调整取还箱组件相对于料箱的位置时,可以先控制底盘组件调整位移的偏移,也可以先控制料箱托盘调节角度偏移,在此不做限制。通过三维成像模组可以使取还箱组件的中心与料箱的中心对准,相对于传统的方法,可避免在料箱上贴标签,而且提升了对准的精度,降低了成本。When adjusting the position of the retrieving and returning box component relative to the material box based on the three-dimensional imaging module, the offset of the adjustment displacement of the chassis component can be controlled first, and the angle offset of the adjustment of the material box tray can also be controlled first, which is not limited here. Through the three-dimensional imaging module, the center of the retrieving and returning box assembly can be aligned with the center of the material box. Compared with the traditional method, labeling on the material box can be avoided, the alignment accuracy is improved, and the cost is reduced.
在该实施例中,通过三维成像模组即实现了搬运机器人在取箱时的位置调整,上述方法可以由搬运机器人实施。搬运机器人可以包括底盘组件、门架组件、取还箱组件、三维成像模组。在上述三维成像模组的基础上,可以在取还箱组件上设置二维成像模组,二维成像模组识别货架层板上的标识码,获得目标箱位标识的位置,得到取还箱组件与标识之间的水平位置偏差;基于获得的所述水平位置偏差,控制底盘组件移动以调整取还箱组件的水平位移,再结合三维成像模组使得取还箱组件与料箱对准后进行取箱。二维成像模组和三维成像模组配合的步骤可以与上述其它实施例相同,在此不再具体说明。也可以是采用上述包括障碍物检测模组的搬运机器人。由此在该实施例中,还可以适应于上述关于障碍物检测模组的步骤,在此不再具体说明。In this embodiment, the position adjustment of the handling robot when picking up the box is realized through the three-dimensional imaging module, and the above method can be implemented by the handling robot. The handling robot may include a chassis component, a door frame component, a retrieval box component, and a three-dimensional imaging module. On the basis of the above-mentioned three-dimensional imaging module, a two-dimensional imaging module can be set on the return box component, and the two-dimensional imaging module can identify the identification code on the shelf layer, obtain the position of the target box position identification, and obtain the return box The horizontal position deviation between the component and the logo; based on the horizontal position deviation obtained, the movement of the chassis component is controlled to adjust the horizontal displacement of the take-and-return box component, and then the three-dimensional imaging module is combined to align the take-and-return box component with the material box Make unboxing. The steps of cooperating between the 2D imaging module and the 3D imaging module may be the same as those in other embodiments above, and will not be described in detail here. It can also be the above-mentioned handling robot including the obstacle detection module. Therefore, in this embodiment, it can also be adapted to the above-mentioned steps related to the obstacle detection module, which will not be described in detail here.
在本公开一个实施方式中,通过合理配置三维成像模组在搬运机器人上的安装位置,上述公开的方法也同样适应于放箱的步骤,例如在一种送箱的方法中,可以基于三维成像模组调整取还箱组件相对于料架上目标箱位的水平偏移和/或高度偏移和/或角度偏移等。需要注意的是,在调整高度偏移时,可以驱动取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面,这样可使料箱能够从较高的料箱托盘上顺利地移动至较低的目标箱位上。In one embodiment of the present disclosure, by rationally configuring the installation position of the three-dimensional imaging module on the handling robot, the method disclosed above is also applicable to the step of putting boxes. The module adjusts the horizontal offset and/or height offset and/or angular offset of the retrieving and returning box assembly relative to the target box position on the rack. It should be noted that when adjusting the height offset, the take-and-return box assembly can be driven up and down to make the bearing surface of the material box tray higher than the bearing surface for placing the material box on the material rack, so that the material box can be placed from a higher The material box pallet moves smoothly to the lower target box position.
本申请在以下实施例中提供一种送箱方法,包括以下步骤:The present application provides a box delivery method in the following embodiments, including the following steps:
步骤S1、搬运机器人行走至目标位置,控制取还箱组件300提升至目标高度;Step S1, the transport robot walks to the target position, and controls the take-and-return box assembly 300 to lift to the target height;
业务系统给搬运机器人下发送料箱的指令,搬运机器人接到业务指令后,基于其导航系统移动至目标(X,Y)位,并根据业务指令中包含的料箱位置信息,将取还箱组件提升到目标高度h。这些坐标信息均预先储存在业务系统中或者搬运机器人中,搬运器机器人根据这些位置信息便能做出相应的操作。The business system sends an instruction to the handling robot to send the material box. After receiving the business order, the handling robot moves to the target (X, Y) position based on its navigation system, and returns the box according to the position information of the material box included in the business order. The component is lifted to the target height h. These coordinate information are pre-stored in the business system or in the handling robot, and the handling robot can make corresponding operations based on the position information.
步骤S2、通过二维成像模组获取料架横梁上标识的位置信息,并基于得到的位置偏差调整所述取还箱组件300的位置;Step S2: Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly 300 based on the obtained position deviation;
由于此时料箱位于料箱托盘中,三维检测模组被料箱阻挡而无法工作。因此在该步骤中通过二维成像模组,基于取还箱组件300的高度位置偏差调整所述取还箱组件300的高度,对取还箱组件300进行高度精准定位,弥补由于地面不平、料架安装精度低或其它原因造成的高度误差。在该实施例中,调整取还箱组件的位置,使得料箱托盘330的承载面高于料架上用于放置料箱的承载面。Since the material box is located in the material box tray at this time, the three-dimensional detection module is blocked by the material box and cannot work. Therefore, in this step, the two-dimensional imaging module is used to adjust the height of the take-and-return box assembly 300 based on the height position deviation of the take-and-return box assembly 300, and to accurately position the take-and-return box assembly 300 to compensate for the unevenness of the ground. The height error caused by low rack installation accuracy or other reasons. In this embodiment, the position of the retrieving and returning box assembly is adjusted so that the bearing surface of the material box tray 330 is higher than the bearing surface for placing material boxes on the material shelf.
并且还可以基于二维成像模组检测到的与料架横梁上标识的横向(水平)偏移,控制底盘组件移动至使取还箱组件的中心与横梁上标识的中心对准。And based on the lateral (horizontal) offset detected by the two-dimensional imaging module and the mark on the beam of the material rack, the chassis assembly can be controlled to move so that the center of the return box assembly is aligned with the center of the mark on the beam.
步骤S3、通过障碍物检测模组分别检测第一伸缩臂310、第二伸缩臂320前方的伸出路径是否被遮挡,Step S3, through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm 310 and the second telescopic arm 320 are blocked,
若至少一侧被遮挡,则停止送箱,上报异常。即只要有一侧被遮挡则直接控制伸缩臂停止伸出并上报异常。此时机器人可以放弃此次送箱任务,等待系统分配任务。If at least one side is blocked, stop delivering boxes and report an exception. That is, as long as one side is blocked, the telescopic arm is directly controlled to stop extending and an abnormality is reported. At this time, the robot can give up the box delivery task and wait for the system to assign the task.
若两侧均无遮挡,则进行步骤S4;If there is no occlusion on both sides, proceed to step S4;
步骤S4、控制取还箱组件300伸出。Step S4, controlling the extension of the retrieval box assembly 300 .
在上述还箱过程中,若通过障碍物检测模组检测到第一伸缩臂310、第二伸缩臂320前方的伸出路径均无遮挡,则可以控制取还箱组件300进行还箱动作。若检测到第一伸缩臂310、第二伸缩臂320至少一个前方的伸出路径被遮挡,则可能是其它料箱占用了部分目标料箱位。若搬运机器人调整位置,其放出的料箱可能会偏离目标料箱位,甚至占用其 它的料箱位,导致旁边的料箱位无法顺利还箱,以致发生连锁的料箱偏移情况。因此,若还箱过程中有一侧被遮挡,则停止还箱,上报异常。机器人也可以放弃此次任务,等待系统分配其它任务,例如通知机器人去其它箱位执行还箱操作。During the above box return process, if the obstacle detection module detects that the extending paths in front of the first telescopic arm 310 and the second telescopic arm 320 are not blocked, then the box retrieval and return assembly 300 can be controlled to perform box return action. If it is detected that at least one of the front extension paths of the first telescopic arm 310 and the second telescopic arm 320 is blocked, it may be that other material boxes occupy part of the target material box positions. If the handling robot adjusts its position, the material box released by it may deviate from the target material box position, or even occupy other material box positions, resulting in the failure of the next material box position to return the box smoothly, resulting in a chain of material box offsets. Therefore, if one side is blocked during the box return process, the box return will stop and an exception will be reported. The robot can also give up this task and wait for the system to assign other tasks, such as informing the robot to return the box to another box location.
本公开的取送箱方法中,如果无法通过改变位置来达到调整的目的,则停止动作,上报异常至业务系统。业务系统接到相应的异常后,可以根据异常的类型向机器人分配不同的任务。In the box pick-up method disclosed in the present disclosure, if the purpose of adjustment cannot be achieved by changing the position, the action is stopped and an abnormality is reported to the business system. After the business system receives the corresponding exception, it can assign different tasks to the robot according to the type of exception.
在本公开一个实施例中,当系统接收到异常信号后,可以通知人工来进行处理,例如人工将料箱摆正后,机器人可以继续执行本次操作。也可以是,系统向机器人分配再次在该箱位进行取还箱的任务。In an embodiment of the present disclosure, when the system receives an abnormal signal, it can notify a human to handle it, for example, after the human being manually arranges the bin, the robot can continue to perform the operation. It may also be that the system assigns the robot the task of picking up and returning the box at the box location again.
在本公开一个实施例中,如果无法通过改变位置来达到调整的目的,机器人可以放弃此次取送箱的任务。当系统接收到异常信号后,可以向机器人分配在其它箱位进行取送箱的操作,并通知人工对出现异常的箱位进行处理。以上已经描述了本申请的各实施例,上述说明是示例性的,并非穷尽性的,并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的情况下,对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。本文中所用术语的选择,旨在最好地解释各实施例的原理、实际应用或对市场中的技术改进,或者使本技术领域的其它普通技术人员能理解本文披露的各实施例。本申请的范围由所附权利要求来限定。In one embodiment of the present disclosure, if the purpose of adjustment cannot be achieved by changing the position, the robot may give up the task of picking up and delivering the box. When the system receives the abnormal signal, it can assign the robot to pick up and deliver the boxes in other boxes, and notify the manual to deal with the abnormal boxes. Having described various embodiments of the present application above, the foregoing description is exemplary, not exhaustive, and is not limited to the disclosed embodiments. Many modifications and alterations will be apparent to those of ordinary skill in the art without departing from the scope and spirit of the described embodiments. The terminology used herein is chosen to best explain the principle of each embodiment, practical application or technical improvement in the market, or to enable other ordinary skilled in the art to understand each embodiment disclosed herein. The scope of the application is defined by the appended claims.

Claims (44)

  1. 一种搬运机器人,其特征在于,包括:A handling robot is characterized in that it comprises:
    底盘组件;Chassis components;
    门架组件,所述门架组件连接在所述底盘组件上;a door frame assembly, the door frame assembly is connected to the chassis assembly;
    取还箱组件,所述取还箱组件被构造为沿着所述门架组件上下移动;所述取还箱组件包括用于伸出或缩回的伸缩叉机构;a retrieval box assembly, the retrieval box assembly is configured to move up and down along the door frame assembly; the retrieval box assembly includes a telescopic fork mechanism for extending or retracting;
    障碍物检测模组,所述障碍物检测模组被配置为用于探测伸缩叉机构的伸出路径是否被遮挡;An obstacle detection module, the obstacle detection module is configured to detect whether the extension path of the telescopic fork mechanism is blocked;
    所述伸缩叉机构被配置为:当障碍物检测模组探测伸缩叉机构的伸出路径无遮挡时伸出。The telescopic fork mechanism is configured to protrude when the obstacle detection module detects that the protruding path of the telescopic fork mechanism is unobstructed.
  2. 根据权利要求1所述的搬运机器人,其特征在于,所述伸缩叉机构包括一对平行布置的第一伸缩臂、第二伸缩臂;所述障碍物检测模组设置有至少两个,分别为设置在第一伸缩臂前端位置的第一障碍物检测模组,以及位于第二伸缩臂前端位置的第二障碍物检测模组。The handling robot according to claim 1, wherein the telescopic fork mechanism includes a pair of first and second telescopic arms arranged in parallel; at least two of the obstacle detection modules are provided, respectively The first obstacle detection module is arranged at the front end of the first telescopic arm, and the second obstacle detection module is arranged at the front end of the second telescopic arm.
  3. 根据权利要求2所述的搬运机器人,其特征在于,所述取还箱组件包括用于承载料箱的料箱托盘,所述第一伸缩臂、第二伸缩臂设置在料箱托盘相对的两侧,且被配置为当第一障碍物检测模组、第二障碍物检测模组检测相应的伸出路径未被遮挡时,相对于所述料箱托盘伸出。The handling robot according to claim 2, wherein the retrieving and returning box assembly includes a box tray for carrying the box, and the first telescopic arm and the second telescopic arm are arranged on opposite sides of the box tray. side, and is configured to protrude relative to the bin tray when the first obstacle detection module and the second obstacle detection module detect that the corresponding protruding path is not blocked.
  4. 根据权利要求3所述的搬运机器人,其特征在于,所述伸缩叉机构每组伸缩臂为一级伸出的伸缩臂,或者为至少两级伸出的伸缩臂;所述障碍物检测模组设置在伸缩叉机构末端伸缩臂的前端位置。The handling robot according to claim 3, characterized in that, each set of telescopic arms of the telescopic fork mechanism is a telescopic arm extended at one stage, or at least two stages extended at the telescopic arm; the obstacle detection module It is arranged at the front end of the telescopic arm at the end of the telescopic fork mechanism.
  5. 根据权利要求3所述的搬运机器人,其特征在于,还包括控制单元,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组检测到相应的伸出路径均被遮挡时,发出停止取料箱指令,并上报异常;以及,The handling robot according to claim 3, further comprising a control unit, the control unit responds to the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension paths are blocked , issue a command to stop the retrieving box and report an exception; and,
    响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧移动相应的距离。In response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to move a corresponding distance to the blocked side.
  6. 根据权利要求5所述的搬运机器人,其特征在于,响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧在预定移动阈值范围内移动相应的距离。The handling robot according to claim 5, characterized in that, in response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to the The shaded side moves a corresponding distance within a predetermined movement threshold.
  7. 根据权利要求5所述的搬运机器人,其特征在于,在伸缩叉机构伸出之前,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧移动相应的距离。The handling robot according to claim 5, wherein before the extension of the telescopic fork mechanism, the control unit responds to one of the first obstacle detection module and the second obstacle detection module detecting the corresponding When the extending path is blocked, the control chassis assembly moves a corresponding distance to the blocked side.
  8. 根据权利要求5所述的搬运机器人,其特征在于,在伸缩叉机构伸出的过程中,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组实时检测时被触发的至少一个电信号时,控制伸缩叉机构停止伸出。The handling robot according to claim 5, characterized in that, during the extension process of the telescopic fork mechanism, the control unit is triggered in response to the real-time detection of the first obstacle detection module and the second obstacle detection module When at least one electrical signal is received, the telescopic fork mechanism is controlled to stop extending.
  9. 根据权利要求1所述的搬运机器人,其特征在于,所述障碍物检测模组为激光传感器或红外传感器。The handling robot according to claim 1, wherein the obstacle detection module is a laser sensor or an infrared sensor.
  10. 根据权利要求1所述的搬运机器人,其特征在于,还包括设置在取还箱组件上的三维成像模组,所述三维成像模组被配置为用于获取料箱的三维位置信息。The handling robot according to claim 1, further comprising a three-dimensional imaging module arranged on the retrieving and returning box assembly, and the three-dimensional imaging module is configured to obtain three-dimensional position information of the material box.
  11. 根据权利要求10所述的搬运机器人,其特征在于,所述取还箱组件包括用于承载料箱的料箱托盘,及位于料箱托盘后端的后挡板;所述三维成像模组设置在后挡板的中心位置。The handling robot according to claim 10, wherein the retrieving and returning box assembly includes a box tray for carrying the box, and a tailgate positioned at the rear end of the box tray; the three-dimensional imaging module is arranged on Center of the tailgate.
  12. 根据权利要求10所述的搬运机器人,其特征在于,包括控制单元,所述控制单元被配置为基于三维成像模组获得的取还箱组件与料箱的位置偏差,控制底盘组件在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度。The handling robot according to claim 10, characterized by comprising a control unit, the control unit is configured to control the chassis assembly at a predetermined movement threshold based on the positional deviation between the retrieval box assembly and the material box obtained by the three-dimensional imaging module and/or control the bin tray to rotate by a corresponding angle within a predetermined rotation threshold range.
  13. 根据权利要求10所述的搬运机器人,其特征在于,所述三维成像模组包括深度相机。The handling robot according to claim 10, wherein the three-dimensional imaging module includes a depth camera.
  14. 根据权利要求1所述的搬运机器人,其特征在于,还包括设置在取还箱组件上的二维成像模组,所述二维成像模组被配置为用于获取料架上标识的位置信息。The handling robot according to claim 1, further comprising a two-dimensional imaging module arranged on the retrieving box assembly, the two-dimensional imaging module is configured to obtain the position information of the mark on the rack .
  15. 根据权利要求14所述的搬运机器人,其特征在于,所述取还箱组件包括基座以及设置在基座上的料箱托盘;所述二维成像模组设置在基座的中心位置,用于获取料架横梁中心位置的标识的位置信息。The handling robot according to claim 14, wherein the retrieving and returning box assembly includes a base and a material box tray arranged on the base; the two-dimensional imaging module is arranged at the center of the base, for It is used to obtain the position information of the mark of the center position of the rack beam.
  16. 根据权利要求15所述的搬运机器人,其特征在于,包括控制单元,所述控制单元被配置为基于二维成像模组获得的与标识的位置偏差,控制底盘组件在预定移动阈值范围内移动相应的距离;和/或控制取还箱组件升降相应的高度。The handling robot according to claim 15, characterized by comprising a control unit configured to control the chassis assembly to move correspondingly within a predetermined movement threshold range based on the position deviation from the mark obtained by the two-dimensional imaging module. and/or control the corresponding height of lifting and lowering the retrieving box assembly.
  17. 根据权利要求16所述的搬运机器人,其特征在于,取料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面;送料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面。The handling robot according to claim 16, wherein when retrieving the material box, drive the retrieving and returning box assembly to lift to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack; When picking up and returning the box, drive the take-and-return box assembly up and down to make the bearing surface of the material box tray higher than the bearing surface for placing the material box on the material rack.
  18. 一种搬运机器人,其特征在于,包括:A handling robot is characterized in that it comprises:
    底盘组件;Chassis components;
    门架组件,所述门架组件连接在所述底盘组件上;a door frame assembly, the door frame assembly is connected to the chassis assembly;
    取还箱组件,所述取还箱组件被构造为沿着所述门架组件上下移动;所述取还箱组件包括用于伸出或缩回的伸缩叉机构;a retrieval box assembly, the retrieval box assembly is configured to move up and down along the door frame assembly; the retrieval box assembly includes a telescopic fork mechanism for extending or retracting;
    三维成像模组,设置在所述取还箱组件上,且所述三维成像模组被配置为用于获取料箱的三维位置信息。A three-dimensional imaging module is arranged on the retrieving and returning box assembly, and the three-dimensional imaging module is configured to obtain three-dimensional position information of the material box.
  19. 根据权利要求18所述的搬运机器人,其特征在于,所述搬运机器人还包括:The handling robot according to claim 18, wherein the handling robot further comprises:
    控制单元,所述控制单元被配置为基于所述三维成像模组获得的所述取还箱组件与料箱的距离偏差,控制所述底盘组件在预定移动阈值范围内移动相应的距离。A control unit configured to control the chassis assembly to move a corresponding distance within a predetermined movement threshold range based on the distance deviation between the retrieving box assembly and the material box obtained by the three-dimensional imaging module.
  20. 根据权利要求19所述的搬运机器人,其特征在于,所述控制单元被配置为基于所述三维成像模组识别到的所述取还箱组件与料箱的横向或水平偏移,驱动所述底盘组件运动至使所述取还箱组件的中心和料箱的中心对齐。The handling robot according to claim 19, wherein the control unit is configured to drive the The chassis assembly is moved to align the center of the retrieval bin assembly with the center of the bin.
  21. 根据权利要求19所述的搬运机器人,其特征在于,所述控制单元还被配置为当所述底盘组件需要移动的距离超出所述预定移动阈值范围时,上报异常。The handling robot according to claim 19, wherein the control unit is further configured to report an abnormality when the distance that the chassis assembly needs to move exceeds the predetermined moving threshold range.
  22. 根据权利要求19所述的搬运机器人,其特征在于,所述控制单元还被配置为取料箱时,控制所述取还箱组件升降至使所述取还箱组件上承载料箱的承载面低于料架上用于放置料箱的承载面;和/或,The handling robot according to claim 19, wherein the control unit is further configured to control the take-and-return box assembly to lift to the load-bearing surface of the take-and-return box assembly when retrieving the material box lower than the load-bearing surface on the rack for the bins; and/or,
    所述控制单元还被配置为送料箱时,控制所述取还箱组件升降至使所述取还箱组件上承载料箱的承载面高于料架上用于放置料箱的承载面。When the control unit is configured as a feeding box, it controls the lifting of the take-and-return box assembly so that the bearing surface of the take-and-return box assembly for carrying the material box is higher than the bearing surface for placing the material box on the material shelf.
  23. 根据权利要求18至22任一项所述的搬运机器人,其特征在于,所述搬运机器人还包括:The handling robot according to any one of claims 18 to 22, wherein the handling robot further comprises:
    控制单元,所述控制单元被配置为基于所述三维成像模组获得的所述取还箱组件与料箱的角度偏差,控制所述取还箱组件在预定转动阈值范围内转动相应的角度。A control unit, the control unit is configured to control the retrieval box assembly to rotate by a corresponding angle within a predetermined rotation threshold range based on the angle deviation between the retrieval box assembly and the material box obtained by the 3D imaging module.
  24. 根据权利要求23所述的搬运机器人,其特征在于,所述控制单元还被配置为当所述取还箱组件需要转动的角度超出所述预定转动阈值范围时,上报异常。The transfer robot according to claim 23, wherein the control unit is further configured to report an abnormality when the rotation angle of the retrieval box assembly exceeds the predetermined rotation threshold range.
  25. 根据权利要求23所述的搬运机器人,其特征在于,所述取还箱组件包括用于承载料箱的料箱托盘,及位于料箱托盘后端的后挡板;所述三维成像模组设置在后挡板的中心位置。The handling robot according to claim 23, wherein the retrieving and returning box assembly includes a box tray for carrying the box, and a rear baffle located at the rear end of the box tray; the three-dimensional imaging module is arranged on Center of the tailgate.
  26. 根据权利要求25所述的搬运机器人,其特征在于,所述取还箱组件还包括基座和旋转机构,所述料箱托盘通过所述旋转机构安装在所述基座上,所述控制单元被配置为通过控制所述旋转机构驱动所述料箱托盘相对于所述基座转动。The handling robot according to claim 25, wherein the retrieving and returning box assembly further includes a base and a rotating mechanism, the bin tray is mounted on the base through the rotating mechanism, and the control unit It is configured to drive the bin tray to rotate relative to the base by controlling the rotating mechanism.
  27. 根据权利要求23所述的搬运机器人,其特征在于,所述三维成像模组包括深 度相机或全景相机。The handling robot according to claim 23, wherein the three-dimensional imaging module includes a depth camera or a panoramic camera.
  28. 根据权利要求23所述的搬运机器人,其特征在于,所述搬运机器人还包括障碍物检测模组,所述伸缩叉机构包括一对平行布置的第一伸缩臂、第二伸缩臂;所述障碍物检测模组设置有至少两个,分别为设置在第一伸缩臂前端位置的第一障碍物检测模组,以及位于第二伸缩臂前端位置的第二障碍物检测模组。The handling robot according to claim 23, characterized in that, the handling robot also includes an obstacle detection module, and the telescopic fork mechanism includes a pair of first and second telescopic arms arranged in parallel; the obstacle There are at least two object detection modules, namely a first obstacle detection module located at the front end of the first telescopic arm, and a second obstacle detection module located at the front end of the second telescopic arm.
  29. 根据权利要求28所述的搬运机器人,其特征在于,所述取还箱组件包括用于承载料箱的料箱托盘,所述第一伸缩臂、第二伸缩臂设置在料箱托盘相对的两侧,且被配置为当第一障碍物检测模组、第二障碍物检测模组检测相应的伸出路径未被遮挡时,相对于所述料箱托盘伸出。The handling robot according to claim 28, wherein the retrieving and returning box assembly includes a material box tray for carrying the material box, and the first telescopic arm and the second telescopic arm are arranged on opposite sides of the material box tray. side, and is configured to protrude relative to the bin tray when the first obstacle detection module and the second obstacle detection module detect that the corresponding protruding path is not blocked.
  30. 根据权利要求29所述的搬运机器人,其特征在于,所述伸缩叉机构每组伸缩臂为一级伸出的伸缩臂,或者为至少两级伸出的伸缩臂;所述障碍物检测模组设置在伸缩叉机构末端伸缩臂的前端位置。The handling robot according to claim 29, characterized in that, each group of telescopic arms of the telescopic fork mechanism is a telescopic arm extended at one stage, or at least two stages extended at the telescopic arm; the obstacle detection module It is arranged at the front end of the telescopic arm at the end of the telescopic fork mechanism.
  31. 根据权利要求30所述的搬运机器人,其特征在于,还包括控制单元,所述控制单元响应于第一障碍物检测模组、第二障碍物检测模组检测到相应的伸出路径均被遮挡时,发出停止取料箱指令,并上报异常;以及,The handling robot according to claim 30, further comprising a control unit, the control unit responds to the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension paths are blocked , issue a command to stop the retrieving box and report an exception; and,
    响应于第一障碍物检测模组、第二障碍物检测模组中其中一个检测到相应的伸出路径被遮挡时,控制底盘组件向该被遮挡的一侧移动相应的距离。In response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, the chassis assembly is controlled to move a corresponding distance to the blocked side.
  32. 一种取送箱方法,应用于根据权利要去1至17任一项所述的搬运机器人,包括取箱步骤和送箱步骤,其特征在于,所述取箱步骤和还箱步骤均包括以下步骤:A method for picking up and delivering boxes, applied to the handling robot described in any one of claims 1 to 17, comprising a box picking step and a box delivery step, characterized in that the box taking step and the box returning step both include the following step:
    步骤S1000,控制取还箱组件提升到目标高度;Step S1000, controlling the take-and-return box assembly to be lifted to the target height;
    步骤S2000,控制障碍物检测模组探测伸缩叉机构的伸出路径是否被遮挡;Step S2000, controlling the obstacle detection module to detect whether the extension path of the telescopic fork mechanism is blocked;
    步骤S3000,响应于障碍物检测模组检测到伸出路径未被遮挡,控制伸缩叉机构伸出。Step S3000, in response to the obstacle detection module detecting that the extending path is not blocked, controlling the telescopic fork mechanism to extend.
  33. 根据权利要求32所述的取送箱方法,其特征在于,所述伸缩叉机构包括第一伸缩臂、第二伸缩臂,所述障碍物检测模组包括用于检测第一伸缩臂伸出路径是否被遮挡的第一障碍物检测模组,及用于检测第二伸缩臂伸出路径是否被遮挡的第二障碍物检测模组;The method for picking and delivering boxes according to claim 32, wherein the telescopic fork mechanism includes a first telescopic arm and a second telescopic arm, and the obstacle detection module includes a Whether the first obstacle detection module is blocked, and the second obstacle detection module used to detect whether the extending path of the second telescopic arm is blocked;
    所述步骤S2000包括:The step S2000 includes:
    步骤S2100,控制第一障碍物检测模组、第二障碍物检测模组分别检测第一伸缩臂、第二伸缩臂的伸出路径是否被遮挡;Step S2100, controlling the first obstacle detection module and the second obstacle detection module to detect whether the extending paths of the first telescopic arm and the second telescopic arm are blocked;
    步骤S2200,响应于第一障碍物检测模组、第二障碍物检测模组中的其中一个检测到相应的伸出路径被遮挡时,控制搬运机器人向被遮挡的一侧移动,直到该侧不被遮挡;以及Step S2200, in response to one of the first obstacle detection module and the second obstacle detection module detecting that the corresponding extension path is blocked, control the handling robot to move to the blocked side until the side is cleared. is obscured; and
    步骤S2300,响应于第一障碍物检测模组、第二障碍物检测模组检测到相应的伸出路径均被遮挡时,发出停止取料箱指令,并上报异常。Step S2300, when the first obstacle detection module and the second obstacle detection module detect that the corresponding extension paths are blocked, issue a command to stop the retrieving box and report an exception.
  34. 根据权利要求32所述的取送箱方法,其特征在于,所述步骤S3000中,在控制伸缩叉机构伸出的过程中,障碍物检测模组实时检测伸缩叉机构的伸出路径是否被遮挡,以及当障碍物检测模组检测到伸出路径被遮挡时,控制伸缩叉机构停止伸出。The method for picking and delivering boxes according to claim 32, characterized in that, in the step S3000, during the process of controlling the extension of the telescopic fork mechanism, the obstacle detection module detects in real time whether the extension path of the telescopic fork mechanism is blocked , and when the obstacle detection module detects that the extending path is blocked, it controls the telescopic fork mechanism to stop extending.
  35. 根据权利要求32所述的取送箱方法,其特征在于,在所述步骤S1000之后,还包括:The method for picking and delivering boxes according to claim 32, characterized in that, after the step S1000, further comprising:
    二维成像模组检测与对应料架横梁上的标识的位置偏差,以及基于该位置偏差控制底盘组价在预定移动阈值范围内移动相应的距离;和/或控制取还箱组件升降相应的高度。The two-dimensional imaging module detects the positional deviation from the mark on the beam of the corresponding material rack, and based on the positional deviation, controls the chassis assembly to move a corresponding distance within a predetermined movement threshold; and/or controls the lifting and lowering of the return box assembly to a corresponding height .
  36. 根据权利要求35所述的取送箱方法,其特征在于,取料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面;送料箱时,驱动所述取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面。The method for retrieving and delivering boxes according to claim 35, characterized in that, when retrieving the material box, drive the retrieving and returning box assembly to lift to make the bearing surface of the material box tray lower than the bearing surface for placing the material box on the material rack ; when feeding the box, drive the take-back box assembly up and down to make the bearing surface of the material box tray higher than the bearing surface for placing the material box on the material rack.
  37. 根据权利要求32所述的取送箱方法,其特征在于,在取箱步骤中,在所述步骤S1000之后,还包括:The box picking method according to claim 32, characterized in that, in the box picking step, after the step S1000, further comprising:
    三维成像模组检测与对应料架上料箱的位置偏差,以及基于该位置偏差控制搬运机器人在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度。The three-dimensional imaging module detects the position deviation of the bin on the corresponding rack, and based on the position deviation controls the handling robot to move a corresponding distance within the predetermined movement threshold range; and/or controls the bin tray to rotate within the predetermined rotation threshold range corresponding angle.
  38. 一种取还箱方法,包括取箱步骤和送箱步骤,应用于搬运机器人,所述搬运机器人包括底盘组件、门架组件、取还箱组件,所述门架组件连接在所述底盘组件上;所述取还箱组件被构造为沿着所述门架组件上下移动,取还箱组件包括用于承载料箱的料箱托盘;还包括二维成像模组,其特征在于,包括以下步骤:A method for taking and returning boxes, comprising a box taking step and a box sending step, applied to a handling robot, the handling robot includes a chassis assembly, a door frame assembly, and a box retrieval and return assembly, and the door frame assembly is connected to the chassis assembly The retrieving and returning box assembly is configured to move up and down along the door frame assembly, and the retrieving and returning box assembly includes a material box tray for carrying material boxes; it also includes a two-dimensional imaging module, characterized in that it includes the following steps :
    S1000′,控制取还箱组件按照系统内预存的目标箱位的高度值提升到目标高度;S1000', controlling the retrieving and returning box assembly to be lifted to the target height according to the height value of the target box position pre-stored in the system;
    S2000′,基于二维成像模组获得的目标箱位标识的位置,得到取还箱组件与标识之间的高度位置偏差;S2000', based on the position of the target box mark obtained by the two-dimensional imaging module, obtain the height position deviation between the retrieving box component and the mark;
    S3000′,在取箱步骤中,基于获得的所述高度位置偏差,控制所述取还箱组件升降至使料箱托盘的承载面低于料架上用于放置料箱的承载面;S3000', in the box taking step, based on the obtained height position deviation, control the lifting and returning box assembly so that the bearing surface of the material box tray is lower than the bearing surface for placing the material box on the material rack;
    S4000′,在送箱步骤中,驱动所述取还箱组件升降至使料箱托盘的承载面高于料架上用于放置料箱的承载面。S4000', in the box sending step, drive the take-and-return box assembly to lift to make the bearing surface of the material box tray higher than the bearing surface for placing material boxes on the material rack.
  39. 根据权利要求38所述的取还箱方法,其特征在于:至少在所述送箱步骤中,还基于二维成像模组获得的目标箱位标识的位置,得到取还箱组件与标识之间的水平位置偏差;基于获得的所述水平位置偏差,控制底盘组件移动以调整取还箱组件的水平位移。The method for retrieving and returning boxes according to claim 38, characterized in that: at least in the box sending step, the distance between the retrieving and returning box assembly and the label is also obtained based on the position of the target box location mark obtained by the two-dimensional imaging module. The horizontal position deviation; based on the obtained horizontal position deviation, control the movement of the chassis assembly to adjust the horizontal displacement of the return box assembly.
  40. 根据权利要求38所述的取还箱方法,其特征在于:在所述取箱步骤中,还包括:The method for taking and returning boxes according to claim 38, characterized in that: in the step of taking boxes, further comprising:
    基于三维成像模组获取料箱的三维信息,得到取还箱组件与料箱之间的位置偏差;Obtain the three-dimensional information of the material box based on the three-dimensional imaging module, and obtain the position deviation between the retrieval box component and the material box;
    控制底盘组件在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度。Controlling the chassis assembly to move a corresponding distance within a predetermined movement threshold range; and/or controlling the bin tray to rotate a corresponding angle within a predetermined rotation threshold range.
  41. 一种取箱方法,其特征在于,包括以下步骤:A method for taking out boxes is characterized in that it comprises the following steps:
    步骤S1、搬运机器人行走至目标位置,控制取还箱组件提升至目标高度;Step S1, the handling robot walks to the target position, and controls the take-and-return box assembly to lift to the target height;
    步骤S2、通过二维成像模组获取料架横梁上标识的位置信息,并基于得到的取还箱组件的位置偏差调整所述取还箱组件的位置;Step S2. Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly based on the obtained position deviation of the retrieval box assembly;
    步骤S3、通过障碍物检测模组分别检测第一伸缩臂、第二伸缩臂前方的伸出路径是否被遮挡,Step S3, through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm and the second telescopic arm are blocked,
    若两侧均被遮挡,则停止取箱,上报异常信息;若单侧被遮挡,则控制底盘组件向被遮挡一侧移动至两侧的伸出路径均未被遮挡,然后进行步骤S4;若两侧均无遮挡,则进行步骤S4;If both sides are blocked, stop taking the box and report abnormal information; if one side is blocked, control the chassis assembly to move to the blocked side until the protruding paths of both sides are not blocked, and then go to step S4; if If there is no occlusion on both sides, go to step S4;
    步骤S4、基于三维成像模组获取料箱的三维信息,获得取还箱组件与料箱之间的位置偏差;Step S4. Obtain the three-dimensional information of the material box based on the three-dimensional imaging module, and obtain the positional deviation between the retrieving and returning box assembly and the material box;
    若所述取还箱组件与料箱的位置偏差在可允许范围外,控制底盘组件在预定移动阈值范围内移动相应的距离;和/或,控制料箱托盘在预定转动阈值范围内转动相应的角度;然后执行步骤S5;If the positional deviation between the retrieving and returning box assembly and the material box is outside the allowable range, control the chassis assembly to move a corresponding distance within a predetermined movement threshold; and/or control the material box tray to rotate within a predetermined rotation threshold Angle; then execute step S5;
    步骤S5、控制取还箱组件伸出。Step S5, controlling the extension of the retrieval box assembly.
  42. 根据权利要求41所述的取箱方法,其特征在于,步骤S2中,基于取还箱组件的高度位置偏差调整所述取还箱组件的高度。The box retrieval method according to claim 41, wherein in step S2, the height of the retrieval box assembly is adjusted based on the height position deviation of the retrieval box assembly.
  43. 一种送箱方法,其特征在于,包括以下步骤:A box delivery method is characterized in that it comprises the following steps:
    步骤S1、搬运机器人行走至目标位置,控制取还箱组件提升至目标高度;Step S1, the handling robot walks to the target position, and controls the take-and-return box assembly to lift to the target height;
    步骤S2、通过二维成像模组获取料架横梁上标识的位置信息,并基于得到的位置偏差调整所述取还箱组件的位置;Step S2. Obtain the position information marked on the crossbeam of the material rack through the two-dimensional imaging module, and adjust the position of the retrieval box assembly based on the obtained position deviation;
    步骤S3、通过障碍物检测模组分别检测第一伸缩臂、第二伸缩臂前方的伸出路径是否被遮挡,Step S3, through the obstacle detection module, respectively detect whether the extending paths in front of the first telescopic arm and the second telescopic arm are blocked,
    若至少一侧被遮挡,则停止送箱,上报异常;若两侧均无遮挡,则进行步骤S4;If at least one side is blocked, stop delivering boxes and report an abnormality; if both sides are not blocked, proceed to step S4;
    步骤S4、控制取还箱组件伸出。Step S4, controlling the extension of the retrieval box assembly.
  44. 根据权利要求43所述的送箱方法,其特征在于,步骤S2中:The box sending method according to claim 43, characterized in that, in step S2:
    基于取还箱组件的高度偏差调整所述取还箱组件的高度;adjusting the height of the retrieval bin assembly based on the height deviation of the retrieval bin assembly;
    基于取还箱组件的水平偏差调整所述取还箱组件的水平位移。The horizontal displacement of the retrieval bin assembly is adjusted based on the horizontal deviation of the retrieval bin assembly.
PCT/CN2022/118445 2021-09-13 2022-09-13 Transport robot and method for retrieving and transporting box WO2023036335A1 (en)

Applications Claiming Priority (6)

Application Number Priority Date Filing Date Title
CN202220680318.9 2021-09-13
CN202111071117.5 2021-09-13
CN202122211632.0U CN216302260U (en) 2021-09-13 2021-09-13 Transfer robot
CN202220680318 2021-09-13
CN202122211632.0 2021-09-13
CN202111071117.5A CN115806136A (en) 2021-09-13 2021-09-13 Transfer robot and box taking and delivering method

Publications (1)

Publication Number Publication Date
WO2023036335A1 true WO2023036335A1 (en) 2023-03-16

Family

ID=85507785

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/118445 WO2023036335A1 (en) 2021-09-13 2022-09-13 Transport robot and method for retrieving and transporting box

Country Status (1)

Country Link
WO (1) WO2023036335A1 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109573449A (en) * 2019-01-29 2019-04-05 北京极智嘉科技有限公司 A kind of transfer robot, products storage circulation system and container method for carrying
CN109941652A (en) * 2019-04-19 2019-06-28 北京极智嘉科技有限公司 A kind of transfer robot
JP2020033165A (en) * 2018-08-31 2020-03-05 株式会社豊田自動織機 Forklift remote control system
CN111409996A (en) * 2020-05-13 2020-07-14 北京极智嘉科技有限公司 Carrying robot, box taking method, cargo loading method of cargo box and storage logistics system
CN211197466U (en) * 2019-11-19 2020-08-07 深圳市海柔创新科技有限公司 Carrying device and carrying robot with same
CN216302260U (en) * 2021-09-13 2022-04-15 北京极智嘉科技股份有限公司 Transfer robot

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020033165A (en) * 2018-08-31 2020-03-05 株式会社豊田自動織機 Forklift remote control system
CN109573449A (en) * 2019-01-29 2019-04-05 北京极智嘉科技有限公司 A kind of transfer robot, products storage circulation system and container method for carrying
CN109941652A (en) * 2019-04-19 2019-06-28 北京极智嘉科技有限公司 A kind of transfer robot
CN211197466U (en) * 2019-11-19 2020-08-07 深圳市海柔创新科技有限公司 Carrying device and carrying robot with same
CN111409996A (en) * 2020-05-13 2020-07-14 北京极智嘉科技有限公司 Carrying robot, box taking method, cargo loading method of cargo box and storage logistics system
CN216302260U (en) * 2021-09-13 2022-04-15 北京极智嘉科技股份有限公司 Transfer robot

Similar Documents

Publication Publication Date Title
CN110537189B (en) Transfer robot and goods taking method based on transfer robot
US11794995B2 (en) Handling robot
WO2020135460A1 (en) Transfer robot, warehouse logistics system and article transferring method
CN111620024A (en) Carrying robot, goods box taking method and goods box placing method
CN210883786U (en) Transfer robot
CN211197464U (en) Carrying device and carrying robot with same
CN210794517U (en) Transfer robot
WO2022242442A1 (en) Robot and material box transfer system
CN216302260U (en) Transfer robot
CN216735893U (en) Container handling device, warehouse system
CN211197466U (en) Carrying device and carrying robot with same
CN113859831A (en) Material box carrying logistics robot
TW202134148A (en) Method and apparatus for controling transport robot and transport robot
WO2023151444A1 (en) Removal method and storage method for warehouse goods, and handling robot
WO2023061223A1 (en) Container handling device, warehousing system, and container taking and placing method
US11794996B2 (en) Handling robot
WO2022161407A1 (en) Container carrying system, robot, and container carrying method
KR20200061114A (en) Carrying Robot Having Elevating Means
WO2023036335A1 (en) Transport robot and method for retrieving and transporting box
WO2021063412A1 (en) Cargo taking and placing control method, device, handling device and handling robot
US20240043207A1 (en) Handling robot
WO2021223351A1 (en) Primary-secondary loading and unloading vehicle system
CN115806136A (en) Transfer robot and box taking and delivering method
WO2023061103A1 (en) Container taking and conveying assembly, loading and unloading device, picking system, logistics sorting system, and container taking and conveying method
TWI820538B (en) Handling assembly collision processing method and apparatus, robot, computer device, computer readable storage medium, and computer program product

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22866796

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE