Control device and control method for moving body
By obtaining the position of the previous loading and unloading device, the placement of the next loading and unloading device is controlled, solving the gap problem of the moving body when configuring loading and unloading devices, and realizing the efficient configuration of trackless loading and unloading devices.
Patent Information
- Application Number
- CN202180101813.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-09-28
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2041-09-28
AI Technical Summary
In existing loading systems, autonomous vehicles are difficult to stop precisely at the target position when loading and unloading equipment is configured, which makes it impossible to configure the gaps between loading and unloading equipment without gaps, and requires the laying of tracks and power supply lines.
The position of the previous loading and unloading equipment is obtained by the moving body control device, and the placement position of the next loading and unloading equipment is controlled based on this, thereby reducing the position estimation error and realizing the close arrangement of multiple loading and unloading equipment.
Even with position estimation errors, loading and unloading equipment can be arranged with the smallest possible gaps to avoid laying tracks and power lines and improve loading and unloading efficiency.
Smart Images

Figure CN117836223B_ABST
Abstract
Description
Technical Field
[0001] This disclosure relates to a control device and control method for a moving body capable of identifying and supporting loading and unloading equipment carrying goods and capable of moving while estimating its own position. Background Technology
[0002] Conventionally, a loading system is known that utilizes multiple work trolleys to load goods onto a truck. Each work trolley has a motor powered via a sliding cable and travels along a track provided along the truck's loading dock (see, for example, Patent Document 1). In this loading system, the initial loading position of the first work trolley is reported to each subsequent work trolley, informing each work trolley of its position from the beginning. Furthermore, each work trolley stores its initial loading position and derives its loading position from the initial position thereafter. Thus, even if the first work trolley is removed from the path due to certain circumstances or the number of work trolleys changes midway, the remaining work trolleys can identify the reference position and continue loading.
[0003] Existing technical documents
[0004] Patent documents
[0005] Patent Document 1: Japanese Patent Application Publication No. 2001-301987 Summary of the Invention
[0006] The problem that the invention aims to solve
[0007] The aforementioned conventional loading systems are specialized equipment used for loading trucks, requiring the laying of tracks and power supply lines. In contrast, using autonomous mobile bodies such as AMRs (Autonomous Mobile Robots) to transport pallets and trolleys eliminates the need for tracks and power supply lines. However, it is difficult to eliminate the estimation error of the autonomous mobile body's own position, making it challenging to stop the mobile body at the target position with high precision. Therefore, when arranging and configuring loading and unloading equipment in a predetermined location using autonomous mobile bodies, in order to suppress interference between loading and unloading equipment, the target position of the transport trolley must be set in a way that ensures a certain degree of spacing between adjacent loading and unloading equipment, making it impossible to configure loading and unloading equipment without gaps in the designated location.
[0008] Therefore, the main objective of this disclosure is to arrange and configure multiple loading and unloading devices in a configuration location with the smallest possible gaps by using a mobile body capable of estimating its own position while moving.
[0009] Technical solutions for solving the problem
[0010] The control device for the mobile body disclosed herein is a control device for a mobile body capable of identifying and supporting loading and unloading equipment for loading goods and capable of moving while estimating its own position. When the mobile body arranges and configures multiple loading and unloading equipment in a configuration location, the control device for the mobile body obtains the position of the previous loading and unloading equipment placed in the configuration location and controls the mobile body to place the next loading and unloading equipment in a manner that determines the position based on the obtained position of the previous loading and unloading equipment.
[0011] The control device of this disclosure, when arranging and configuring multiple loading and unloading devices in a configuration location using a mobile body capable of estimating its own position, obtains the position of the previous loading and unloading device placed in the configuration location. Furthermore, the control device controls the mobile body to place the next loading and unloading device at a position determined based on the obtained position of the previous loading and unloading device. Thus, even if there is an error in estimating the mobile body's own position, the next loading and unloading device can be placed in the configuration location while minimizing the gap with the previous loading and unloading device. As a result, according to the control device of this disclosure, multiple loading and unloading devices can be arranged and configured in the configuration location with the smallest possible gap.
[0012] The control method for the mobile body disclosed herein is a method for controlling a mobile body capable of identifying and supporting loading and unloading equipment for loading goods and capable of moving while estimating its own position. In this method, when the mobile body arranges and configures multiple loading and unloading equipment in a configuration location, the position of the previous loading and unloading equipment placed in the configuration location is obtained, and the mobile body is controlled to place the next loading and unloading equipment in a manner that determines the position based on the obtained position of the previous loading and unloading equipment.
[0013] According to this method, even if there is an error in estimating the position of the moving body, the next loading / unloading device can be placed in the configuration location while minimizing the gap with the previous loading / unloading device. As a result, multiple loading / unloading devices can be arranged and configured in the configuration location with the smallest possible gaps. Attached Figure Description
[0014] Figure 1 This is a schematic structural diagram of a logistics center that represents a mobile body that incorporates the control devices of this disclosure.
[0015] Figure 2 It means Figure 1 A flowchart of the logistics management system of the logistics center.
[0016] Figure 3 It means in Figure 1 A 3D view of the trolleys used in the logistics center.
[0017] Figure 4 This is a perspective view showing a movable body including the control device of this disclosure.
[0018] Figure 5 This is a control block diagram of the control device for the moving body disclosed herein.
[0019] Figure 6 This is a flowchart illustrating the steps of positioning a mobile body, including the control device of this disclosure, as a loading and unloading device in a storage location.
[0020] Figure 7 This is a flowchart illustrating other steps for configuring a mobile body, including the control device of this disclosure, as a loading and unloading device in a storage location.
[0021] Figure 8 This is a flowchart illustrating other steps for configuring a mobile body, including the control device of this disclosure, as a loading and unloading device in a storage location. Detailed Implementation
[0022] Next, with reference to the accompanying drawings, the method for carrying out the invention disclosed herein will be described.
[0023] Figure 1 This is a schematic structural diagram of a logistics center 1 that utilizes an autonomous mobile robot (AMR) 50, which includes the control device disclosed herein, as an application of this invention. Figure 2 This is a block diagram representing the logistics management system 10 of logistics center 1.
[0024] Figure 1 The logistics center 1 shown is a facility for the storage, transportation, loading and unloading, packaging, and distribution processing of goods (commodities). As shown, in addition to multiple handling robots 50, the logistics center 1 also includes: an entrance 2 for delivery vehicles T such as trucks; a shipping area 3 with multiple shipping doors 3a, 3b, 3c, 3d, 3e, 3f, 3g, 3h, 3i, 3j, 3k, and 3l (hereinafter, appropriately referred to collectively as shipping doors and "shipping door 3x"); a conveyor 4 that transports multiple packaged goods P from the warehouse not shown to the shipping area 3; and multiple trolleys 5. In the logistics center 1, goods P are transported to the shipping area 3 by the conveyor 4 and transferred to the trolleys 5. Furthermore, the trolleys 5, which are loading and unloading devices for goods P, are transported by the handling robots 50 to the corresponding shipping doors 3x. Then, the trolleys 5 loaded with goods P are loaded onto the corresponding delivery vehicles T at the shipping doors 3x and transported to their shipping destination by the delivery vehicles T.
[0025] At the entrance 2 of logistics center 1, there are: an entrance camera 20 to capture images of delivery vehicles T arriving at the entrance 2; a monitor 21 to visually provide various information to the driver of the delivery vehicle T; and an entrance management device 25 (see reference). Figure 2 The entrance management device 25 is a computer including a CPU, ROM, RAM, storage device, communication module, etc., which obtains the ID of the delivery vehicle T arriving at entrance 2 based on the image data captured by the entrance camera 20. That is, the entrance camera 20 and the entrance management device 25 function as ID acquisition devices for entrance 2. In this embodiment, the ID of the delivery vehicle T is, for example, a number pre-assigned to the delivery vehicle T from the logistics center 1, and a mark (not shown) indicating this ID is affixed to the delivery vehicle T so that it can be identified from the entrance camera 20. However, the ID of the delivery vehicle T can be the vehicle registration number of the delivery vehicle T, or it can be the number of an on-board unit such as ETC obtained via a communication device (not shown). Furthermore, the entrance management device 25 causes the monitor 21 to display information that should be provided to the driver.
[0026] In addition, each of the delivery gates 3a-3l is equipped with: a camera 30 to capture images of the delivery vehicle T arriving at that delivery gate 3a-3l; a trolley detector 31 capable of capturing images of the trolley 5 passing by during loading onto the delivery vehicle T; and a delivery gate management device 35 (see reference). Figure 2 The delivery gate management device 35 is a computer including a CPU, ROM, RAM, storage device, communication module, etc., which obtains the ID of the delivery vehicle T arriving at delivery gates 3a, 3b, ..., 3l based on the video data (image data) captured by the camera 30. That is, the camera 30 and the delivery gate management device 35 function as delivery vehicle ID acquisition devices for each delivery gate 3a-3l. In addition, the delivery gate management device 35 obtains the ID of the trolley 5 loaded on the delivery vehicle T based on the image data captured by the trolley detector 31. That is, the trolley detector 31 and the delivery gate management device 35 function as trolley ID acquisition devices for each delivery gate 3a-3l.
[0027] The conveyor 4 includes a main transport line 40 and multiple delivery lines 4a, 4b, 4c, 4d, 4e, 4f, 4g, 4h, 4i, 4j, 4k, 4l (hereinafter, the delivery lines are collectively referred to as "delivery lines 4x") branching off from the main transport line 40 in a relative manner corresponding to the delivery gates 3a-3l, respectively. The conveyor 4 is controlled by a computer, namely the conveyor control device 14, which includes a CPU, ROM, RAM, storage devices, communication modules, etc. (see reference 14). Figure 2Control. A barcode label indicating its ID is affixed to the goods P processed by the logistics center 1. The conveyor control device 14 controls the conveyor 4 based on the ID of the goods P. That is, the conveyor control device 14 obtains the ID of the goods P on the main transport line 40 via a barcode reader (not shown), and controls the conveyor 4 to sort the goods P transported to the shipping area 3 via the main transport line 40 to the corresponding shipping line 4x based on the obtained ID.
[0028] Cart 5 is Figure 3 The so-called basket-type trolley as shown includes identification marks 5m such as AR marks, QR codes (registered trademarks), and barcodes indicating the ID of the trolley 5. The mark 5m is affixed to at least one location on the trolley 5 (in...). Figure 3 In the example, there are two parts, so that they can be identified by the handling robot 50 and the trolley detector 31. Additionally, in the logistics center 1, such as... Figure 1 As shown, a storage location (configuration location) 6 is ensured within the shipping area 3. Unused trolleys 5 are arranged and configured in the storage location 6. The trolleys 5 intended for use are identified by the handling robots 50 and transported from the storage location 6 to the designated location. Furthermore, multiple markings 3m, such as AR tags and QR codes (registered trademarks), are affixed to the floor, pillars, etc., of the shipping area 3 within the logistics center 1 building to enable each handling robot 50 to move autonomously.
[0029] like Figure 2 As shown, the logistics management system 10 includes a management server 11 and a storage device 12, which serve as management devices. The management server 11 is a computer equipped with a CPU, ROM, RAM, communication module, etc. The management server 11 obtains various information from the inlet management device 25 and the outlet management devices 35 of each outlet gate 3a-3l, and sends the information and instruction signals required by the inlet management device 25 and each outlet management device 35. Furthermore, the management server 11 sends information required for the classification of goods P, such as the ID of goods P, to the conveyor control device 14, and exchanges information with the AMR management device 15. The AMR management device 15 is a computer including a CPU, ROM, RAM, storage device, communication module, etc., and manages the multiple handling robots 50 by exchanging information with them via wireless communication.
[0030] In addition, the storage device 12 of the logistics management system 10 stores a delivery database that saves information related to the delivery of goods P according to each of the multiple delivery vehicles T assigned IDs from the logistics center 1. This delivery database stores the ID of the goods P loaded on the delivery vehicle T, the destination of the goods P, and the ID of the loading gate 3x (hereinafter appropriately referred to as "loading gate 3z") used to load the goods onto the delivery vehicle T, all in association (establishing a link) with the ID of the delivery vehicle T. Furthermore, the storage device 12 stores area information including the movable and prohibited areas of the transport robot 50 in the shipping area 3 (logistics center 1), identification information of each area, location information of marker 3m, and time periods during which movement is prohibited.
[0031] Figure 4 This is a 3D diagram representing the transport robot 50. Figure 5 This is the control block diagram of the handling robot 50. (Example) Figure 4 and Figure 5 As shown, the handling robot 50 includes multiple (4) Mecanum wheels 51, multiple (4) electric motors 52 that drive the corresponding Mecanum wheels 51 to rotate, and a lifting unit 53 for raising and lowering the trolley 5, configured to move forward and backward under the trolley 5. Each Mecanum wheel 51 includes a pair of support plates 51p and multiple rollers 51r, which are supported by the pair of support plates 51p in a ring arrangement and are capable of rotating about an axis inclined at 45° relative to the axle. Thus, by controlling the rotation direction and speed of the multiple electric motors 52, the handling robot 50 can move in all directions and can rotate in place, rotate horizontally, or rotate slowly. The lifting unit 53 includes: a support member that supports the trolley 5; and a drive device that raises and lowers the support member relative to the main body of the handling robot 50, so that each wheel of the trolley 5 is separated from or in contact with the road surface.
[0032] Furthermore, the handling robot 50 includes a camera 54 as a shooting device, a control unit 55, a communication module 56 for communication (wireless communication) with the AMR management unit 15 and other handling robots 50, and a storage device 57. The camera 54 captures images of the area around the handling robot 50 and sends the captured data (image data) to the control unit 55. The control unit 55 is a computer including a CPU, ROM, RAM, etc. Figure 5 As shown, in the control device 55, the arithmetic processing unit 55G, the driving control unit 55D, and the lifting control unit 55L are constructed through the cooperation of hardware such as CPU, ROM, and RAM with various pre-installed programs.
[0033] The processing unit 55G of the control device 55 utilizes VSLAM (Voice over Simulation) technology to acquire the robot's own position (3D coordinates) and environmental map within the shipping area 3 (logistics center 1) at predetermined intervals (microsecond intervals) based on data captured by the camera 54 during the movement of the transport robot 50, and stores these data in the storage device 57. Furthermore, the processing unit 55G can identify (distinguish) the marker 3m in the shipping area 3, the marker 5m (ID of the cart 5) on the cart 5, and the cart itself, based on the data captured by the camera 54. Moreover, the processing unit 55G identifies the marker 3m located in the shipping area 3 during the movement of the transport robot 50 and corrects its own position and environmental map estimated based on the pre-determined position of the marker 3m. Additionally, the processing unit 55G can adjust the sensitivity (gain of the imaging element) and exposure time (shutter speed) of the camera 54. Furthermore, the processing unit 55G stores in the storage device 57 the shooting conditions of the camera 54 when it normally identifies objects such as markers 3m and 5m from the shooting data of the camera 54, namely the sensitivity and exposure time, in association with the location (ID) of the marker 3m and the time period during which the marker 3m and the other are captured.
[0034] The driving control unit 55D of the control device 55 controls multiple electric motors 52 based on its own position (current position), environmental map, etc., acquired by the computing unit 55G. Furthermore, when the transport robot 50 is located below the corresponding trolley 5, the lifting control unit 55L controls the lifting unit 53 to raise or lower the trolley 5. In addition, the computing unit 55G of the control device 55 can be configured to acquire its own position and environmental map using SLAM technology such as 2D or 3D LiDAR (laser sensor), or it can be configured to estimate its own position based solely on the location of markers, or it can be configured to acquire its own position and environmental map using indoor positioning technology such as beacons. Furthermore, the transport robot 50 may include wheels other than those with general rubber tires or Mecanum wheels (registered trademark).
[0035] Here, unused trolleys 5 in the shipping area 3 of logistics center 1 are stored in the storage area 6 within the shipping area 3. However, to improve the space efficiency of the shipping area 3, it is required to minimize the size of the storage area 6 and to arrange multiple trolleys 5 without gaps in the storage area 6. However, it is difficult to eliminate the estimation error of the trolley 5's own position relative to the transport robot 50 moving in and out of the storage area, making it difficult to stop the transport robot 50 at the target position with high precision. Therefore, the control device 55 of the transport robot 50 is designed according to... Figure 6 , Figure 7 and Figure 8The steps shown control the transport robot 50 to store the trolleys 5 designated by the AMR management device 15 in the storage area 6, so that the spacing between adjacent trolleys 5 in the storage area 6 is as small as possible. Furthermore, in this embodiment, the storage area 6 is divided into multiple configuration zones, each containing one trolley 5. At least in the configuration zone where the initial trolley 5 is stored (hereinafter referred to as the "initial configuration zone"), markings (not shown) are provided so that they can be captured by the camera 54 of the transport robot 50.
[0036] Figure 6 This is a flowchart illustrating the steps of storing multiple trolleys 5 in an empty storage area 6 using a single transport robot 50. The travel control unit 55D of the control device 55 of the single transport robot 50 controls multiple electric motors 52 based on its own position estimated by the processing unit 55G, so that the transport robot 50 moves to the vicinity of the trolley 5 that is the initial storage target designated from the AMR management device 15. Furthermore, when the processing unit 55G of the control device 55 recognizes the mark 5m of the trolley 5, the travel control unit 55D controls the multiple electric motors 52 to move the transport robot 50 under the trolley 5. Then, the lifting control unit 55L of the control device 55 controls the lifting unit 53 to raise the trolley 5. Thus, the initial trolley 5 is supported by the transport robot 50 (step S100). Additionally, in step S100, the travel control unit 55D of the control device 55 reads the initial configuration zone information received from the AMR management device 15, indicating where the initial trolley 5 should be configured. The information for initial partition configuration can be the coordinates of the initial partition configuration, or the partition number (ID), etc.
[0037] After the processing in step S100, the driving control unit 55D of the control device 55 controls multiple electric motors 52 based on the initial configuration partition information from the AMR management device 15 and its own position estimated by the processing unit 55G, so that the transport robot 50 moves to the periphery of the initial configuration partition. The processing unit 55G identifies the marker of the initial configuration partition based on the shooting data of the camera 54 (step S110). Then, the driving control unit 55D determines the stopping position of the transport robot 50 based on the position of the marker of the initial configuration partition identified by the processing unit 55G, and controls multiple electric motors 52 to move the transport robot 50 to the stopping position (step S120). In addition, after stopping the transport robot 50, the processing unit 55G of the control device 55 obtains the coordinates of the stopping position of the transport robot 50 and stores the coordinates as the coordinates of the last configuration partition in the storage device 57 (step S120). In addition, the lifting control unit 55L of the control device 55 controls the lifting unit 53 to lower the trolley 5. When the wheels of the trolley 5 touch the ground, the travel control unit 55D of the control device 55 controls multiple electric motors 52 to make the transport robot 50 exit from under the trolley 5 (step S130). Thus, the initial trolley 5 is stored in the initial configuration section.
[0038] When the initial trolley 5 is stored in the initial configuration zone, the travel control unit 55D of the control device 55 determines whether the AMR management device 15 has instructed the storage of the next trolley 5 (step S140). If the travel control unit 55D determines that the storage of the next trolley 5 has not been instructed (step S140: no), it controls multiple electric motors 52 to move the transport robot 50 to a predetermined standby position (step S210), thereby ending the storage of the trolley 5 in the storage location 6.
[0039] In contrast, when it is determined that the next trolley 5 has been designated for storage (step S140: Yes), the travel control unit 55D controls multiple electric motors 52 to move the transport robot 50 to the vicinity of the designated next trolley 5. Furthermore, when the arithmetic processing unit 55G of the control device 55 recognizes the mark 5m of the next trolley 5, the travel control unit 55D of the control device 55 controls multiple electric motors 52 to move the transport robot 50 under the trolley 5. Then, the lifting control unit 55L of the control device 55 controls the lifting unit 53 to raise the trolley 5. Thus, the trolley 5 of the next storage target is supported by the transport robot 50 (step S150). Additionally, in step S150, the travel control unit 55D of the control device 55 reads the coordinates of the initial configuration zone where the first trolley 5 is located from the storage device 57; in other words, it reads the coordinates of the previous configuration zone where the storage location 6 of the previous trolley 5 is located. Then, the driving control unit 55D sets the coordinates of the current configuration partition of the next trolley 5 to be configured based on the coordinates of the previous configuration partition (initial configuration partition) (step S160).
[0040] Next, the driving control unit 55D of the control device 55 controls multiple electric motors 52 to move the transport robot 50 to the periphery of the current configuration zone based on the coordinates of the current configuration zone where the next trolley 5 should be configured and the self-position estimated by the processing unit 55G. The processing unit 55G identifies the marker of the trolley 5 stored in the previous configuration zone (initial configuration zone) based on the data captured by the camera 54 (step S170). Furthermore, the driving control unit 55D controls multiple electric motors 52 to move the transport robot 50 to the coordinates of the current configuration zone based on the position of the marker 5m of the trolley 5 in the previous configuration zone identified by the processing unit 55G (step S180). In addition, after the transport robot 50 stops, the processing unit 55G of the control device 55 obtains the coordinates of the stopping position of the transport robot 50 and stores these coordinates as the coordinates of the current configuration zone in the storage device 57 (step S180). Furthermore, the lifting control unit 55L of the control device 55 controls the lifting unit 53 to lower the trolley 5, and when the wheels of the trolley 5 touch the ground, the travel control unit 55D controls multiple electric motors 52 to cause the transport robot 50 to exit from under the trolley 5 (step S190). Thus, the next (second) trolley 5 is stored in the current configuration partition.
[0041] After the processing in step S190, the travel control unit 55D of the control device 55 determines whether the number of trolleys 5 specified by the AMR management device 15 has been stored in the storage location (step S200). If the control device 55 determines that the specified number of trolleys 5 have not been stored in the storage location (step S200: No), it executes the processing after step S150 described above. In this case, in step S150, the coordinates of the current configuration partition stored in the most recent step S180 are read as the coordinates of the previous configuration partition. Then, if it is determined that the number of trolleys 5 specified in step S200 has been stored in the storage location (step S200: Yes), multiple electric motors 52 are controlled to move the transport robot 50 to a predetermined standby position (step S210), thus ending the storage of the trolleys 5 in the storage location 6.
[0042] Next, refer to Figure 7 and Figure 8 The steps for using multiple handling robots 50 to store multiple trolleys 5 in an empty storage area 6 are explained.
[0043] The control device 55 (travel control unit 55D) of the first transport robot 50 designated by the AMR management device 15 controls multiple electric motors 52 to move the transport robot 50 to the vicinity of the trolley 5, which is the initial storage object designated by the AMR management device 15. Furthermore, when the arithmetic processing unit 55G recognizes the mark 5m of the trolley 5, the control device 55 of the first transport robot 50 controls the multiple electric motors 52 and the lifting unit 53 to enable the transport robot 50 to support the initial trolley 5 (step S300). Additionally, in step S300, the control device 55 (travel control unit 55D) of the first transport robot 50 reads the initial configuration zone information received from the AMR management device 15 indicating where the initial trolley 5 should be configured.
[0044] After the processing in step S300, the control device 55 (travel control unit 55D) of the first transport robot 50 controls multiple electric motors 52 to move the transport robot 50 to the periphery of the initial configuration zone. The control device 55 (processing unit 55G) identifies the marker of the initial configuration zone based on the data captured by the camera 54 (step S310). Then, the control device 55 (travel control unit 55D) of the first transport robot 50 determines the stopping position of the transport robot 50 based on the position of the marker of the initial configuration zone identified by the processing unit 55G, and controls multiple electric motors 52 to move the transport robot 50 to that stopping position (step S320). Furthermore, after stopping the transport robot 50, the control device 55 (processing unit 55G) acquires the coordinates of the stopping position of the transport robot 50 and stores these coordinates as the coordinates of the last configuration zone in the storage device 57 (step S320). Then, the control device 55 of the first transport robot 50 controls the lifting unit 53 to lower the trolley 5, and controls multiple electric motors 52 to exit from under the trolley 5 after the wheels of the trolley 5 contact the ground (step S330). Thus, the initial trolley 5 is stored in the initial configuration partition.
[0045] When the initial trolley 5 is stored in the initial configuration zone, the control device 55 (travel control unit 55D) of the first transport robot 50 determines whether the AMR management device 15 has instructed further storage of the trolley 5 (step S340). If the control device 55 (travel control unit 55D) determines that no further storage of the trolley 5 has been instructed (step S340: No), it controls multiple electric motors 52 to move the transport robot 50 to a predetermined standby position (S345), thus completing the storage of the trolley 5 to the storage location 6. Conversely, if the control device 55 (travel control unit 55D) of the first transport robot 50 determines that further storage of the trolley 5 has been instructed (step S340: Yes), it controls multiple electric motors 52 to move the transport robot 50 to the vicinity of the trolley 5 designated for storage (step S350). Furthermore, in step S350, the control device 55 controls multiple electric motors 52 and lifting units 53 to enable the handling robot 50 to support the trolley 5, thereby temporarily putting the handling robot 50 into standby mode.
[0046] Additionally, the control device 55 (travel control unit 55D) of the second transport robot 50 designated from the AMR management device 15 controls multiple electric motors 52 to move the transport robot 50 to the vicinity of the next trolley 5 designated by the AMR management device 15 as the storage target. Furthermore, when the arithmetic processing unit 55G recognizes the mark 5m on the trolley 5, the control device 55 of the second transport robot 50... Figure 8 As shown, multiple electric motors 52 and lifting units 53 are controlled to enable the transport robot 50 to support the next trolley 5 (step S400). Furthermore, in step S400, the control device 55 (travel control unit 55D) of the second transport robot 50 requests the coordinates of the previously configured partition (initial configuration partition) that housed the initial trolley 5 from the first transport robot 50, and obtains the coordinates of the previously configured partition (initial configuration partition) from the first transport robot 50. Additionally, the control device 55 (travel control unit 55D) sets the coordinates of the current configuration partition that should house the next trolley 5 based on the coordinates of the previously configured partition (initial configuration partition) (step S410).
[0047] Next, the control unit 55 (travel control unit 55D) of the second transport robot 50 controls multiple electric motors 52 to move the transport robot 50 to the periphery of the current configuration zone. The processing unit 55G of the control unit 55 of the second transport robot 50 identifies the markings of the trolleys 5 stored in the previous configuration zone (initial configuration zone) based on the data captured by the camera 54 (step S420). Furthermore, the control unit 55 (travel control unit 55D) controls multiple electric motors 52 to move the transport robot 50 to the coordinates of the current configuration zone based on the position of the marking 5m of the trolley 5 in the previous configuration zone identified by the processing unit 55G (step S430). In addition, after the transport robot 50 stops, the processing unit 55G of the control unit 55 acquires the coordinates of the stopping position of the transport robot 50 and stores these coordinates as the coordinates of the current configuration zone in the storage device 57 (step S430). Then, the control device 55 of the second transport robot 50 controls the lifting unit 53 to lower the trolley 5, and controls multiple electric motors 52 to exit from under the trolley 5 after the wheels of the trolley 5 contact the ground (step S440). Thus, the next (second) trolley 5 is stored in the current configuration partition.
[0048] After the processing in step S440, the control device 55 (travel control unit 55D) of the second transport robot 50 determines whether further storage of the trolley 5 has been instructed from the AMR management device 15 (step S450). If the control device 55 (travel control unit 55D) determines that no further storage of the trolley 5 has been instructed (step S450: No), it controls multiple electric motors 52 to move the transport robot 50 to a predetermined standby position (S455), thus completing the storage of the trolley 5 to the storage location 6. Conversely, if the control device 55 (travel control unit 55D) of the second transport robot 50 determines that further storage of the trolley 5 has been instructed (step S450: Yes), it controls multiple electric motors 52 to move the transport robot 50 to the vicinity of the trolley 5 that has become the designated storage object (step S460). Furthermore, in step S460, the control device 55 controls multiple electric motors 52 and lifting units 53 to enable the handling robot 50 to support the trolley 5, thereby temporarily putting the handling robot 50 into standby mode.
[0049] Furthermore, for example, when three or more trolleys 5 are stored in the storage location 6 using the first and second transport robots 50 mentioned above, the second transport robot 50 performs the operation... Figure 8 After processing steps S400-S460, the first conveying robot 50 performs the operation. Figure 8 The processing steps S400-S460 are as follows. In this case, in step S400, the first transport robot 50 obtains the coordinates of the current configuration partition obtained by the second transport robot 50 in step S430, and uses them as the coordinates of the previous configuration partition. Furthermore, when three or more trolleys 5 are stored in the storage area 6 by three or more transport robots 50, the second transport robot 50 performs the following... Figure 8 After processing steps S400-S460, the process is executed by the third handling robot 50. Figure 8 The processing steps S400-S460.
[0050] As explained above, when the control device 55 of the handling robot 50, which is a moving body capable of estimating its own position while moving, arranges and configures multiple trolleys 5 (loading and unloading devices) in the storage area 6, it obtains the position of the previous trolley 5 placed in the storage area 6, i.e., the coordinates of the last configuration zone. Figure 6 Step S150 Figure 8 Step S400). Furthermore, the control device 55 controls the transport robot 50 to place the next trolley 5 at a position determined based on the coordinates of the previously configured partition (the position of the previous trolley 5), i.e., the current configuration partition. Figure 6Steps S160-S190, Figure 8 (Steps S410-S440). Therefore, even if there is an error in estimating the position of the transport robot 50 (processing unit 55G), the gap between it and the previous trolley 5 can be minimized, and the next trolley 5 can be placed in the configuration area of the storage space 6. As a result, multiple trolleys 5 can be arranged and configured in the storage space 6 with the smallest possible gaps.
[0051] In addition, when the control device 55 places the next trolley 5 in the storage area 6, it identifies the mark 5m of the previous trolley 5 and moves the handling robot 50 based on the position of the mark 5m of the previous trolley 5. Figure 6 Step S180 Figure 8 (Step S430). This allows for a further reduction in the gap between the previous trolley 5 and the next trolley 5.
[0052] Then, the control device 55 obtains the position of the previous trolley 5, i.e., the coordinates of the last configured partition, and stores it in the storage device 57. Figure 6 Step S120), and obtain the position of the next trolley 5, i.e., the coordinates of the current partition configuration, and store them in the storage device 57. Figure 6 (Step S180). Thus, multiple trolleys 5 can be arranged and configured in the storage area 6 with the smallest possible gaps using a single handling robot 50.
[0053] Furthermore, when multiple transport robots 50 are used to store multiple trolleys 5 in the storage area 6, the position of the previous trolley 5, i.e., the coordinates of the last configured partition, is obtained by the transport robot 50 (other moving body) that placed the previous trolley 5 in the storage area 6. Figure 7 In step S320, the control device 55 of the transport robot 50 that moves the next trolley 5 obtains the coordinates of the previously configured partition from the control device 55 of the transport robot 50 (other moving bodies) that moved the previous trolley 5. Figure 8 (Step S400). Thus, multiple handling robots 50 can be used to arrange and configure multiple trolleys 5 sequentially in the storage area 6 with the smallest possible gaps. However, in this case, the position of the previous trolley 5, i.e., the coordinates of the previously configured partition, does not necessarily need to be directly exchanged between the handling robots 50 as described above; the coordinates of the previously configured partition can be exchanged indirectly between the handling robots 50. That is, in... Figure 7 In step S320, the coordinates of the previously configured partition can also be sent from the control device 55 of the transport robot 50 that transported the previous trolley 5 to the AMR management device 15. Figure 8In step S400, the control device 55 of the transport robot 50 that transports the next trolley 5 can also obtain the coordinates of the previously configured partition from the AMR management device 15 (other device).
[0054] Furthermore, when the control device 55 of the handling robot 50 places the initial trolley 5 in the storage area 6, it identifies a mark attached to the initial placement zone where the initial trolley 5 should be placed, and moves the handling robot 50 based on the position of the mark. Figure 6 Step S120 Figure 7 (Step S320). Thus, the initial trolley 5 can be configured with high precision in the initial configuration partition. However, the control device 55 of the handling robot 50 can also control the handling robot 50 to place the initial trolley 5 in the initial configuration partition based on the coordinates (pre-specified absolute position) of the initial configuration partition of the storage location 6.
[0055] Furthermore, the storage location of the trolley 5 is not limited to the storage location set up in the logistics center 1; for example, it can also be a storage location set up in a retail store, shopping center, or the back office of a retail store. Moreover, the placement location of the trolley 5 can also be set up around a production line, such as a component assembly line. Furthermore, the loading and unloading equipment stored in the storage location (placement location) is not limited to the trolley 5; it can also be a pallet without wheels.
[0056] Furthermore, the handling robot 50 includes multiple Mecanum wheels 51, each driven by a corresponding electric motor 52. This further enhances the freedom of movement of the handling robot 50, enabling it to move smoothly in all directions.
[0057] Furthermore, the invention disclosed herein is not limited to the embodiments described above, and various modifications can be made within the scope of this disclosure. Moreover, the above embodiments are merely one specific way of the invention described in the summary section of the invention, and do not limit the elements of the invention described in the summary section of the invention.
[0058] Industrial applicability
[0059] The invention disclosed herein can be used in the manufacturing industry of mobile bodies that can identify and support loading and unloading equipment carrying goods and move while estimating their own position.
[0060] Explanation of reference numerals in the attached figures
[0061] 1. Logistics Center, 2. Entrance, 3. Outbound Area, 3a, 3b, 3c, 3d, 3e, 3f, 3g, 3h, 3i, 3j, 3k, 3l, 3x Outbound Gates, 3m Marking, 4. Conveyor, 4a, 4b, 4c, 4d, 4e, 4f, 4g, 4h, 4i, 4j, 4k, 4l, 4x Outbound Line, 40. Main Handling Line, 5. Carts, 5m Marking, 6. Storage Area, 10. Logistics Management System, 11. Management Server, 12. Storage Device, 14. Conveyor Control Unit 15AMR management device, 20 entrance camera, 21 monitor, 25 entrance management device, 30 camera, 31 vehicle detector, 35 outbound door management device, 50 handling robot, 51 Mecanum wheel, 51p support plate, 51r roller, 52 electric motor, 53 lifting unit, 54 camera, 55 control device, 55D driving control unit, 55G computing processing unit, 55L lifting control unit, 56 communication module, 57 storage device, P cargo, T delivery vehicle.
Claims
1. A control device for a mobile body, the mobile body being capable of recognizing and supporting a loading / unloading device for loading goods, and being capable of moving while estimating its own position, wherein, When the control device of the mobile body causes the mobile body equipped with the camera to arrange and position the multiple loading and unloading devices at the designated location, When the initial loading and unloading equipment is positioned at the designated location, a position marker attached to the initial configuration zone where the initial loading and unloading equipment should be positioned is identified based on an image captured by the imaging device, and the moving body is moved based on the position of the position marker. When placing the next loading / unloading equipment at the designated location, the position of the previous loading / unloading equipment placed at the location is obtained by recognizing an image captured by the imaging device of the equipment markings attached to the equipment. The moving body is then controlled to place the next loading / unloading equipment at a position determined based on the obtained position of the previous loading / unloading equipment. The control device includes a processing unit capable of adjusting the sensitivity and exposure time of the imaging device. The processing unit associates the sensitivity and exposure time of the location marker and the instrument marker when identifying the location marker and the instrument marker from the shooting data of the shooting device with the location of the location marker and the instrument marker and the time period during which the location marker and the instrument marker were photographed and stores them in the storage device.
2. The control device for the moving body according to claim 1, wherein, When the next loading / unloading device is positioned at the location, the control device of the moving body identifies the device markings attached to the previous loading / unloading device based on the image captured by the imaging device, and moves the moving body with the position of the previous loading / unloading device as a reference.
3. The control device for a moving body according to claim 1 or 2, wherein, The control device of the moving body obtains the position of the previous loading and unloading device and stores it in the storage device, and obtains the position of the next loading and unloading device and stores it in the storage device.
4. The control device for a moving body according to claim 1 or 2, wherein, The position of the previous loading / unloading equipment is obtained by other mobile bodies that place the previous loading / unloading equipment at the designated location. The control device of the mobile body obtains the position of the previous loading and unloading device directly or indirectly from the other mobile bodies.
5. The control device for a moving body according to claim 1 or 2, wherein, The control device of the mobile body controls the mobile body in such a way that the initial loading and unloading equipment is configured at a predetermined location in the configuration site.
6. The control device for a moving body according to claim 1 or 2, wherein, The designated location is a storage area for the loading and unloading equipment located near a logistics center, shop, or production line.
7. The control device for a moving body according to claim 1 or 2, wherein, The loading and unloading equipment is a trolley or pallet.
8. The control device for a moving body according to claim 1 or 2, wherein, The moving body includes multiple wheels that are driven to rotate by corresponding electric motors and are capable of moving in all directions.
9. A method for controlling a mobile body, the mobile body being able to identify and support a loading / unloading device for loading goods, and being able to move while estimating its own position, wherein, In the control method for the moving body, when the moving body equipped with the shooting device arranges and positions the plurality of loading and unloading devices at the designated location, When the initial loading and unloading equipment is positioned at the designated location, a position marker attached to the initial configuration zone where the initial loading and unloading equipment should be positioned is identified based on an image captured by the imaging device, and the moving body is moved based on the position of the position marker. When placing the next loading / unloading equipment at the designated location, the position of the previous loading / unloading equipment placed at the location is obtained by recognizing an image captured by the imaging device of the equipment markings attached to the equipment. The moving body is then controlled to place the next loading / unloading equipment at a position determined based on the obtained position of the previous loading / unloading equipment. In the control method for the moving body, the sensitivity and exposure time of the shooting device can be adjusted, and the sensitivity and exposure time when the location mark and the instrument mark are identified from the shooting data of the shooting device are associated with the location of the location mark and the instrument mark and the time period during which the location mark and the instrument mark are photographed and stored in a storage device.
Citation Information
Patent Citations
Loading system
JP2001301987A
Shelf arrangement system, conveyance robot, and shelf arrangement method
CN107922119A
