Mobile

The mobile object stabilizes cargo transport by using detection and control systems to adjust movement speed and navigate around unstable areas, ensuring stable transit.

JP7594652B2Active Publication Date: 2024-12-04FUJI CORP
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
JP2023503259
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2021-03-03
Publication Date
2024-12-04
Estimated Expiration
2041-03-03

AI Technical Summary

Technical Problem

Existing transport vehicles cannot adjust their moving speed to maintain stability when transporting unstable cargo, risking instability and potential cargo fall.

Method used

A mobile object equipped with a holding device, drive device, detection device, and control device to stabilize cargo by adjusting movement parameters based on stability parameters, and an area estimation device to manage unstable cargo areas.

Benefits of technology

Ensures stable transportation of cargo by dynamically adjusting movement speed and avoiding unstable areas, maintaining cargo stability throughout transit.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007594652000001
    Figure 0007594652000001
  • Figure 0007594652000002
    Figure 0007594652000002
  • Figure 0007594652000003
    Figure 0007594652000003
Patent Text Reader

Abstract

A moving body according to the present disclosure is equipped with a retention device for retaining a package. The moving body comprises: a driving device for moving the moving body; a detection device for detecting a parameter pertaining to the degree of stability of the package in the retention device while the moving body is in motion; and a control device that determines whether the state of the package is stable or not, by using the parameter pertaining to the degree of stability, and if the state of the package is determined to be unstable, the control device executes stabilizing control which controls the driving device so as to stabilize the state of the package.
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present specification discloses a mobile object. [Background technology]

[0002] Conventionally, there are known moving bodies that transport luggage. For example, Patent Document 1 discloses a transport vehicle that determines whether the state of the luggage is stable or not based on the measurement value of an acceleration sensor while transporting the luggage, and instructs an operator to reload the luggage if it determines that the luggage is not stable. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2020-158092 A Summary of the Invention [Problem to be solved by the invention]

[0004] However, in the transport vehicle described in Patent Document 1, even if the state of the luggage is unstable, the moving speed of the transport vehicle when transporting the luggage cannot be changed, which may cause the control of the moving body to become unstable or the luggage to fall.

[0005] The present disclosure has been made to solve such problems, and has as its main object to move a moving body while keeping luggage stable. [Means for solving the problem]

[0006] The first moving body of the present disclosure is A moving body having a holding device for holding luggage, A drive device that moves the moving body; a detection device that detects a parameter related to a stability degree of the luggage on the holding device while the moving body is moving; a control device that uses the parameter related to the stability degree to determine whether or not the state of the luggage is stable, and if it is determined that the state of the luggage is not stable, executes stabilization control to control the drive device so that the state of the luggage is stabilized; It is equipped with the following:

[0007] In the first moving body of the present disclosure, a parameter related to the stability degree is used to determine whether the state of the luggage is stable, and if it is determined that the state of the luggage is not stable, stabilization control is performed to control the drive device so that the state of the luggage is stabilized. Therefore, the stability degree of the luggage is reflected in the movement of the moving body, and the moving body can be moved in a stable state of the luggage.

[0008] The second moving body of the present disclosure is A moving body having a holding device for holding luggage, A drive device that moves the moving body; an area estimation device that estimates an area in which the moving object is moving; A storage device; a control device that receives a stabilization control corresponding to a luggage unstable area where the luggage state is unstable from a management device that manages the moving body or another moving body different from the moving body, stores the stabilization control in the storage device, reads out the stabilization control corresponding to the luggage unstable area from the storage device before the moving body passes through the luggage unstable area stored in the storage device, and executes the read out stabilization control when the moving body passes through the luggage unstable area; It is equipped with the following:

[0009] In a second moving body of the present disclosure, a stabilization control corresponding to a luggage unstable area where the luggage state is unstable is received from a management device that manages the moving body or another moving body different from the moving body, and stored in a storage device, and before the moving body passes through the luggage unstable area stored in the storage device, the stabilization control corresponding to the luggage unstable area is read from the storage device, and the read stabilization control is executed when passing through the luggage unstable area. Therefore, even if the moving body cannot determine whether the luggage state is stable, it is possible to move the moving body with the luggage stable. [Brief description of the drawings]

[0010] [Figure 1] FIG. 1 is a schematic explanatory diagram showing an example of a mobile device system 1. [Diagram 2] FIG. 2 is an explanatory diagram showing an example of an automatic moving device 40. [Diagram 3] FIG. [Figure 4] 11 is a flowchart showing an example of an automatic movement processing routine. [Diagram 5] FIG. 2 is an explanatory diagram showing the state of luggage P on the loading platform 13. [Figure 6] FIG. 2 is an explanatory diagram showing the state of luggage P on the loading platform 13. [Figure 7] 5 is a flowchart showing an example of a stabilization control subroutine. [Figure 8] FIG. 4 is an explanatory diagram showing an example of stabilization data D. [Figure 9] FIG. 11 is an explanatory diagram showing another example of the stabilization control. [Figure 10] FIG. 11 is an explanatory diagram showing another example of the stabilization control. [Figure 11] FIG. 1 is an explanatory diagram showing an example of a drone 80. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0011] An embodiment of the present disclosure will be described with reference to the drawings. Fig. 1 is a schematic explanatory diagram showing an example of a moving device system 1. Fig. 2 is an explanatory diagram showing an example of an automatic moving device 40. Fig. 3 is a plan view of the automatic moving device 40. Note that in this embodiment, the left-right direction, the front-rear direction, and the up-down direction (in Fig. 3, the up-down direction is a direction perpendicular to the paper surface) will be described as shown in each figure.

[0012] As shown in Fig. 1, the moving device system 1 comprises a management device 26 and a plurality of automatic moving devices 40. The management device 26 comprises a control device 27, a storage unit 28, and a communication unit 29. The control device 27 has a CPU and is responsible for controlling the entire device. The storage unit 28 stores various application programs, various data files, the moving route R of the automatic moving device 40, etc. The communication unit 29 communicates with external devices such as the automatic moving device 40.

[0013] The automatic moving device 40 is a moving body having four Mecanum wheels 44 attached to the front, rear, left and right sides of a vehicle body 40a, and moves along a moving route R according to movement instructions received from the management device 26. This automatic moving device 40 is configured as an AMR (Autonomous Mobile Robot) that moves by detecting its surroundings.

[0014] As shown in Figures 2 and 3, the automatic moving device 40 has a loading platform 13, a detection device 20, a memory unit 41, a lift surface 42, a lift device 43, a Mecanum wheel 44, a drive unit 45, a distance measurement sensor 46, a gyro sensor 47, an acceleration sensor 48, a communication unit 49, and a control unit 50.

[0015] The loading platform 13 is the upper surface of the vehicle body 40a. In the moving device system 1, a baggage P is loaded onto the loading platform 13 by a robot or an operator (not shown). The automatic moving device 40 moves along the moving route R with the baggage P loaded onto the loading platform 13.

[0016] The detection device 20 is a device for detecting a baggage P on the loading platform 13. The detection device 20 has first to fourth detection units 21 to 24 provided at the four corners of the loading platform 13. The first detection unit 21 is provided at the right front corner of the loading platform 13, the second detection unit 22 is provided at the left front corner of the loading platform 13, the third detection unit 23 is provided at the right rear corner of the loading platform 13, and the fourth detection unit 24 is provided at the left rear corner of the loading platform 13. The first detection unit 21 is provided with a plurality of pressure sensors 21a to 21i (three in this example) in the front-rear direction and a plurality of pressure sensors 21a to 21i (three in this example) in the left-right direction. The pressure sensors are named with the alphabets a, b, and c in the order from the top right to the left, d, e, and f in the order from the center right to the left, and g, h, and i in the order from the bottom right to the left. Similarly, the second detection unit 22 includes pressure sensors 22a-22i, the third detection unit 23 includes pressure sensors 23a-23i, and the fourth detection unit 24 includes pressure sensors 24a-24i. Here, the pressure sensors 21a-21i, 22a-22i, 23a-23i, and 24a-24i are referred to as pressure sensors when there is no particular distinction between them. The pressure sensor constituting each detection unit outputs a signal indicating that a package P is present on the sensor (hereinafter referred to as an ON signal) to the control unit 50 if there is a package P on the pressure sensor, and outputs a signal indicating that no package P is present on the sensor (hereinafter referred to as an OFF signal) to the control unit 50 if there is no package P on the sensor.

[0017] The storage unit 41 stores various application programs and various data files.

[0018] The lift surface 42 is a liftable surface provided in the center of the loading platform 13. The lift device 43 raises and lowers and tilts the lift surface 42 via two rods 421, 422 attached to the front and rear of the back surface of the lift surface 42.

[0019] The Mecanum wheels 44 have a structure in which multiple rollers are provided on the ground surface side, which are inclined 45 degrees to the axle and supported so as to be freely rotatable. This automatic mobile device 40 is equipped with four Mecanum wheels 44, and is configured so that each wheel can rotate forward or backward independently to move the automatic mobile device 40 in all directions and perform pivot turns, pivot turns, gentle turns, etc.

[0020] The drive unit 45 is a motor that is connected to each Mecanum wheel 44 and drives the automatic moving device 40 to move by rotating the connected Mecanum wheels 44.

[0021] The distance measuring sensor 46 detects objects and obstacles present around the automatic mobile device 40 and their distance. The distance measuring sensor 46 detects the presence of objects and their distance by irradiating the surroundings with light such as a laser or sound waves and detecting reflected waves. The distance measuring sensor 46 is configured to be able to detect the presence of objects in the entire outer periphery of the automatic mobile device 40.

[0022] The gyro sensor 47 detects the vehicle body direction and arrangement angle of the automatic moving device 40 and inputs them to the control unit 50. The acceleration sensor 48 detects the acceleration when the automatic moving device 40 moves and inputs them to the control unit 50.

[0023] The communication unit 49 wirelessly exchanges information with the management device 26 and other automatic moving devices 40 constituting the moving device system 1. The control unit 50 moves the automatic moving device 40 along the moving route R to the target position G based on a command obtained from the management device 26 via the communication unit 49.

[0024] The control unit 50 is a controller that controls the entire automatic moving device 40. The control unit 50 outputs control signals to the memory unit 41, the lift device 43, the drive unit 45, and the communication unit 49, and also inputs signals from the first to fourth detection units 21 to 24 on the loading platform 13, the distance measurement sensor 46, the gyro sensor 47, the acceleration sensor 48, and the communication unit 49. The control unit 50 determines the stability of the luggage P on the loading platform 13 based on the ON signal or OFF signal of each pressure sensor 21a to 24i, and estimates the position of the automatic moving device 40 relative to the moving route R by grasping the moving direction and moving distance of the automatic moving device 40 based on the driving state of the drive unit 45. The control unit 50 also creates an environmental map of the periphery of the automatic moving device 40 based on an input signal from the distance measurement sensor 46, outputs a control signal for controlling the lift device 43 based on an input signal from the gyro sensor 47, and outputs a control signal for driving and controlling the drive unit 45 based on an input signal from the acceleration sensor 48.

[0025] Next, the process in which the automatic moving device 40 automatically moves along the moving route R in the moving device system 1 configured as above will be described with reference to Figs. 4 to 8. Fig. 4 is a flowchart showing an example of an automatic moving process routine. Figs. 5 and 6 are explanatory diagrams showing the state of luggage P on the loading platform 13. Fig. 7 is a flowchart showing an example of a stabilization control subroutine. Fig. 8 is an explanatory diagram showing an example of stabilization data D. The automatic moving process routine and the stabilization control subroutine are stored in the memory unit 41. The automatic moving process routine is executed after receiving an automatic moving command from the management device 26.

[0026] When this routine is started, the control unit 50 acquires a movement route R (S100). Specifically, the control unit 50 acquires the movement route R of the automatic moving device 40 as shown in FIG. 1 together with an automatic movement command from the management device 26, and stores it in the memory unit 41. The movement route R is a route connecting the initial position S and the target position G. Next, the control unit 50 sets the driving mode of the automatic moving device 40 to a normal driving mode (S110). Here, the normal driving mode refers to a driving mode in which the control unit 50 drives and controls the drive unit 45 so that the automatic moving device 40 moves along the movement route R at a relatively large acceleration and speed.

[0027] Next, the control unit 50 determines whether or not the stabilization data D contains information on the travel route R (S120). Specifically, as shown in Fig. 8, if the stabilization data D stores the contents of the luggage unstable area and the stable driving mode associated with the travel route R, the control unit 50 makes a positive determination in S120, and otherwise makes a negative determination.

[0028] If it is determined in S120 that the stabilization data D does not contain information corresponding to the moving route R, the control unit 50 stores the detection signals of each pressure sensor (S130). Specifically, the control unit 50 stores in the memory unit 41 whether the detection signal input to the control unit 50 from the pressure sensors 21a-24i is an ON signal or an OFF signal. For example, if the state of the baggage P on the loading platform 13 is as shown in Fig. 5, the control unit 50 stores in the memory unit 41 that only the pressure sensors 21i, 22g, 23c, and 24a are inputting ON signals, and the other pressure sensors are inputting OFF signals.

[0029] Next, the control unit 50 judges whether the luggage P is moving on the loading platform 13 (S140). Specifically, the control unit 50 compares the signal contents of each pressure sensor stored in the memory unit 41 in the previous S130 with the signal contents of each pressure sensor stored in the memory unit 41 in the current S130, and judges whether there is a difference between the two. For example, assume that the previous state of the luggage P is the state shown in FIG. 5, and the current state of the luggage P is the state shown in FIG. 6. In this case, the signals of the pressure sensors 21i, 22g, 23c, and 24a were ON signals and the rest were OFF signals in the previous state, whereas the signals of the pressure sensors 21e, 21f, 21h, 21i, 22d, 22g, 23b, 23c, and 24a are ON signals and the rest are OFF signals in the current state. Therefore, a difference occurs between the signal contents of each pressure sensor in the previous state and the signal contents of each pressure sensor in the current state. Therefore, the control unit 50 judges that the luggage P has moved on the loading platform 13. In addition, when the control unit 50 executes S140 for the first time after starting this routine, the contents of the signals from each pressure sensor stored in the memory unit 41 in the previous S130 do not exist, so for convenience it is determined that the luggage P is not moving.

[0030] If it is determined in S140 that the luggage P is not moving on the loading platform 13, the control unit 50 proceeds to 170. On the other hand, if it is determined in S140 that the luggage P is moving on the loading platform 13, the control unit 50 executes the stabilization control subroutine (S150). When the stabilization control subroutine is started, the control unit 50 stores the stable running start position in the storage unit 41 as shown in FIG. 7 (S151). Specifically, the control unit 50 estimates the odometry position of the automatic moving device 40 with respect to the moving route R when the stabilization control subroutine is started by odometry, and stores the position in the storage unit 41 as the stable running start position. The odometry refers to calculating the amount of movement of the automatic moving device 40 from the initial position S and the direction in which the automatic moving device 40 has moved based on the cumulative driving amount per unit time of the driving unit 45 connected to each Mecanum wheel 44.

[0031] Next, the control unit 50 sets the travel mode of the automatic moving device 40 to a stable travel mode (S152). Here, the stable travel mode refers to a travel mode in which the control unit 50 controls the drive unit 45 to reduce the magnitude of acceleration or slow down the travel speed of the automatic moving device 40 so that the baggage P is less likely to move on the loading platform 13. Specifically, when the automatic moving device 40 is accelerating or decelerating (when there is an input signal from the acceleration sensor 48 indicating that acceleration or deceleration has been detected), the control unit 50 controls the drive unit 45 so that the absolute value of the acceleration or deceleration decreases by a predetermined value. Also, when the automatic moving device 40 is moving at a constant speed (when there is no input signal from the acceleration sensor 48 indicating that acceleration or deceleration has been detected), the control unit 50 controls the drive unit 45 so that the speed of the automatic moving device 40 decreases by a predetermined value.

[0032] Next, the control unit 50 judges whether the state of the luggage P is stable or not (S153). This judgment is performed in the same manner as S140. If the control unit 50 judges in S153 that the state of the luggage P is not stable, it returns to S152 again, and if it judges that the state of the luggage P is stable, it changes the travel mode of the automatic moving device 40 from the stable travel mode to the normal mode (S154). In this way, the control unit 50 reduces the acceleration or deceleration of the automatic moving device 40, or reduces the speed, until the state of the luggage P is stable.

[0033] Next, the control unit 50 stores the stable driving end position in the storage unit 41 (S155). Specifically, the control unit 50 estimates the odometry position of the automatic moving device 40 at the time when the stable driving mode ends by odometry, and stores the position in the storage unit 41 as the stable driving end position.

[0034] Then, the control unit 50 updates the stabilization data D (S156). Specifically, the control unit 50 sets the area between the stable running start position estimated in S151 and the stable running end position estimated in S156 as a baggage unstable area, and stores the current baggage unstable area and the contents of the stable running mode in association with the movement route R in the storage unit 41. As a result, when the automatic moving device 40 moves through this baggage unstable area again, it is possible to pass the baggage P through the baggage unstable area in a stable state by reading and executing the stabilization control that has already been executed. Thereafter, the control unit 50 ends the stabilization control subroutine and proceeds to S160 of the automatic movement processing routine.

[0035] Next, the control unit 50 shares the stabilization data D with the other automatic moving devices 40 constituting the moving device system 1 (S160). Specifically, the control unit 50 transmits the stabilization data D to the other automatic moving devices 40 or the management device 26 via the communication unit 49. When the control unit 50 transmits the stabilization data D to the management device 26, the stabilization data D is shared by the management device 26 transmitting the stabilization data D to the other automatic moving devices 40 via the communication unit 29. Therefore, when the other automatic moving devices 40 approach the luggage unstable area, the automatic moving devices 40 can be moved with the luggage P in a stable state by executing a process similar to the stabilization control already executed.

[0036] Next, it is determined whether or not the automatic moving device 40 has reached the target position G (S170). Specifically, the control unit 50 determines whether or not the odometry position of the automatic moving device 40 is the target position G. If the automatic moving device 40 has not reached the target position G, the process returns to S130 again.

[0037] Next, a process will be described when it is determined in S120 that information corresponding to the moving route R is stored in the stabilization data D. If it is determined in S120 that information corresponding to the moving route R is stored in the stabilization data D, the control unit 50 estimates its own position (S190). Specifically, the control unit 50 estimates an odometry position of the automatic moving device 40 with respect to the moving route R by odometry.

[0038] Next, the control unit 50 judges whether the automatic moving device 40 is approaching the luggage unstable area (S200). Specifically, the control unit 50 judges whether the odometry position of the automatic moving device 40 estimated in S190 is within a predetermined distance from the stable running start position of the luggage unstable area of ​​the moving route R stored in the memory unit 41. If the odometry position of the automatic moving device 40 estimated in S190 is not within a predetermined distance from the stable running start position of the luggage unstable area, the control unit 50 judges that the automatic moving device 40 is not approaching the luggage unstable area and proceeds to S260. On the other hand, if the odometry position of the automatic moving device 40 estimated in S190 is within a predetermined distance from the stable running start position of the luggage unstable area, the control unit 50 judges that the automatic moving device 40 is approaching the luggage unstable area and reads out the stabilization data D stored in the memory unit 41 (S210). Specifically, the control unit 50 determines the content of the stable driving mode corresponding to the luggage unstable area to which the automatic moving device 40 is approaching (for example, if the automatic moving device 40 is approaching luggage unstable area A of the stabilization data D shown in FIG. 8, the movement speed of the automatic moving device 40 is 10 [m / s] or less, and if the automatic moving device 40 is approaching luggage unstable area B, the acceleration is 2 [m / s] or less). 2 ]) is read out from the stabilization data D stored in the storage unit 41.

[0039] Next, the control unit 50 executes stabilization control (S220). Specifically, the control unit 50 controls the drive unit 45 so that the travel mode of the automatic traveling device 40 becomes the stable travel mode read out in S210 when the automatic traveling device 40 enters the luggage unstable area. Next, the control unit 50 estimates the self-position of the automatic traveling device 40 with respect to the travel route R (S230). Specifically, the control unit 50 estimates the position of the automatic traveling device 40 with respect to the travel route R by odometry.

[0040] Next, the control unit 50 judges whether the automatic moving device 40 has passed through a baggage unstable area (S240). Specifically, the control unit 50 judges whether the odometry position of the automatic moving device 40 estimated in S230 is included in the baggage unstable area of ​​the moving route R. If the odometry position of the automatic moving device 40 estimated in S230 is included in the baggage unstable area (between the stable running start position and the stable running end position), the control unit 50 judges that the automatic moving device 40 has not passed through the baggage unstable area, and returns to S230 again.

[0041] On the other hand, if the odometry position of the automatic moving device 40 estimated in S230 is not included in the luggage unstable area, the control unit 50 determines that the automatic moving device 40 has passed through the luggage unstable area, and sets the driving mode of the automatic moving device 40 to normal mode (S250).

[0042] Then, the control unit 50 judges whether or not the automatic moving device 40 has reached the target position G (S260). This judgment is the same as S170 described above. If it is judged that the automatic moving device 40 has not reached the target position G, the process returns to S190 again. On the other hand, if it is judged in S260 or in S170 described above that the automatic moving device 40 has reached the target position G, the control unit 50 ends this routine.

[0043] Here, the correspondence between the components of this embodiment and those of the present disclosure will be clarified. The automatic moving device 40 of this embodiment corresponds to the moving body of the present disclosure, the loading platform 13 corresponds to the holding device, the driving unit 45 and the Mecanum wheel 44 correspond to the driving device, the detection device 20 corresponds to the detection device, and the control unit 50 corresponds to the control device. In addition, the memory unit 41 corresponds to the storage device of the present disclosure, and the control unit 50 corresponds to the area estimation device. Furthermore, the management device 26 corresponds to the management device of the present disclosure.

[0044] In the automatic moving device 40 described above, the detection signals of the pressure sensors 21a-21i, 22a-22i, 23a-23i, and 24a-24i are used to determine whether the state of the luggage P is stable, and if it is determined that the state of the luggage P is not stable, stabilization control is performed to drive and control the drive unit 45 so as to stabilize the state of the luggage P. Therefore, the degree of stability of the luggage P is reflected in the movement of the automatic moving device 40, and the automatic moving device 40 can be moved while the luggage P is in a stable state.

[0045] Furthermore, if the control unit 50 determines that the state of the luggage P is not stable, it executes stabilization control, stores the executed stabilization control in the memory unit 41 in association with the luggage unstable area where the state of the luggage P was not stable, reads out from the memory unit 41 the stabilization control corresponding to the luggage unstable area before the automatic moving device 40 passes through the luggage unstable area stored in the memory unit 41 again, and executes the read stabilization control when the automatic moving device 40 passes through the luggage unstable area. In other words, since the same stabilization control as the stabilization control already executed when the automatic moving device 40 approaches the luggage unstable area again is read out in advance and executed, when the automatic moving device 40 moves through the luggage unstable area, it is possible to move the automatic moving device 40 with the luggage P in a stable state.

[0046] Furthermore, the control unit 50 transmits the stabilization control stored in the memory unit 41 in association with the luggage unstable area to the management device 26 that manages the automatic moving device 40 or to another automatic moving device 40 constituting the moving device system 1. Therefore, information on the luggage unstable area and the stabilization control can be shared with the other automatic moving devices 40. Therefore, when the other automatic moving devices 40 approach the luggage unstable area, by executing a control similar to the stabilization control that has already been executed, the other automatic moving devices 40 can be moved with the luggage P in a stable state.

[0047] It goes without saying that the present disclosure is in no way limited to the above-described embodiment, and can be embodied in various forms as long as it falls within the technical scope of the present disclosure.

[0048] For example, in the above embodiment, the luggage unstable area and the stabilization control are associated with each other and stored in the storage unit 41 in S156 of the stabilization control subroutine, but this is not limited thereto. For example, only the luggage unstable area may be stored in the storage unit 41 in S156 of the stabilization control subroutine. In this way, when the automatic moving device 40 approaches the luggage unstable area again, the automatic moving device 40 can move while avoiding the luggage unstable area, so that the luggage P can move in a stable state. In this case, the luggage unstable area may be transmitted to the management device 26 or another automatic moving device 40 constituting the moving device system 1. In this way, the automatic moving device 40 can share information about the luggage unstable area with the other automatic moving device 40. Therefore, when the other automatic moving device 40 approaches the luggage unstable area, it can move while avoiding the luggage unstable area, so that the other automatic moving device 40 can move with the luggage P in a stable state.

[0049] In the above-described embodiment, the stabilization data D may be data received from another automatic moving device 40 constituting the moving device system 1 and stored in the storage unit 41. In this way, even if the automatic moving device 40 cannot determine whether the state of the luggage P on the loading platform 13 is stable, the automatic moving device 40 can move the luggage P in a stable state.

[0050] In the above-described embodiment, instead of the pressure sensor, an optical sensor including a light emitting element and a light receiving element may be used.

[0051] In the above-described embodiment, the first to fourth detection units 21 to 24 each include nine pressure sensors, but this is not limited to this. For example, the first to fourth detection units 21 to 24 may each include ten or more sensors, or eight or less sensors.

[0052] In the above-described embodiment, the control unit 50 also serves as the area estimation device of the present disclosure, but is not limited to this. For example, the automatic moving device 40 may be provided with an area estimation device separate from the control unit 50.

[0053] In the above-described embodiment, the self-position of the automatic moving device 40 is estimated by odometry, but the present invention is not limited to this. For example, the self-position of the automatic moving device 40 with respect to the moving route R may be estimated by GPS, the self-position of the automatic moving device 40 with respect to the moving route R may be estimated by using SLAM (Simultaneous Localization and Mapping), or the self-position of the automatic moving device 40 may be estimated by using an AR (Augmented Reality) marker.

[0054] In the above embodiment, in S140 of the automatic movement processing routine, whether or not the state of the baggage P on the loading platform 13 is stable is determined based on the signals output by the pressure sensors 21a to 24i provided on the loading platform 13, but this is not limiting. For example, whether or not the baggage P on the loading platform 13 is stable may be determined by determining whether or not the wheels are spinning or slipping from the difference between the self-position (hereinafter referred to as the SLAM position) of the automatic moving device 40 with respect to the moving route R estimated by SLAM and the odometry position. Here, the SLAM position is estimated, for example, as follows. That is, first, an environmental map associated with the moving route R is created in advance. Then, the control unit 50 estimates the position of the automatic moving device 40 with respect to the moving route R by comparing the environmental map created by the automatic moving device 40 while moving along the moving route R with the environmental map created in advance. In this case, if the odometry position is closer to the target position G than the SLAM position, it may be determined that the wheels are spinning, and if the SLAM position is closer to the target position G than the odometry position, it may be determined that the wheels are slipping.

[0055] In the above-described embodiment, the moving route R is stored in the management device 26, but is not limited thereto. For example, the moving route R may be derived by the management device 26 or the automatic moving device 40 based on the initial position S and the target position G. When the management device 26 derives the moving route R, the management device 26 derives the moving route R connecting the initial position S and the target position G before transmitting the automatic moving command to the automatic moving device 40. When the automatic moving device 40 derives the moving route R, the automatic moving device 40 receives the automatic moving command and the initial position S and the target position G, and creates an environmental map or estimates its own position by, for example, SLAM, and derives the moving route R connecting the initial position S and the target position G based on the environmental map and its own position.

[0056] In the above embodiment, if the state of the baggage P on the loading platform 13 is not stable, the control unit 50 drives and controls the drive unit 45, but this is not limited to the above. For example, when the automatic moving device 40 moves in the moving direction shown in FIG. 9, the lift device 43 may be controlled according to the inclination of the ground on which the automatic moving device 40 moves. For example, if the automatic moving device 40 moves on the horizontal plane H1 as in state A, the control unit 50 controls the lift device 43 so that the heights of the front and rear rods 421, 422 on the back side of the lift surface 42 are the same, thereby making the lift surface 42 horizontal. Next, as in state B, if the automatic moving device 40 moves to the upwardly inclined surface T1 and the gyro sensor 47 inputs a detection signal indicating that the automatic moving device 40 is moving on an upwardly inclined surface, the control unit 50 extends and retracts the front rod 421 and the rear rod 422 in a direction that cancels the inclination, as in state C, to keep the lift surface 42 horizontal. Next, as in state D, when the automatic moving device 40 moves to the horizontal plane H2 and the gyro sensor 47 no longer inputs a detection signal of the inclination of the automatic moving device 40, the control unit 50 controls the lift device 43 so that the heights of the front and rear rods 421, 422 are the same, thereby making the lift surface 42 horizontal. Then, as in state E, when the automatic moving device 40 moves to the downward inclined surface T2 and the gyro sensor 47 inputs a detection signal indicating that the automatic moving device 40 is moving on the downward inclined surface T2, the control unit 50 extends and retracts the front rod 421 and the rear rod 422 in a direction to cancel the inclination, thereby keeping the lift surface 42 horizontal. Alternatively, as shown in FIG. 10, the lift device 43 may be controlled according to the acceleration and deceleration of the automatic moving device 40. In this case, first, the automatic moving device 40 starts moving from a stopped state as in state G to state H, and when the acceleration sensor 48 detects the acceleration of the automatic moving device 40, the control unit 50 inclines the lift surface 42 by extending and retracting the front rod 421 and the rear rod 422 in a direction to cancel the inertial force so that the baggage P does not slide in the opposite direction to the moving direction of the automatic moving device 40 due to the inertial force as shown in state I. Next, when the automatic moving device 40 moves at a constant speed and the acceleration detection signal is no longer input from the acceleration sensor 48 as shown in state J, the control unit 50 controls the lift device 43 so that the heights of the front and rear rods 421, 422 are the same, and makes the lift surface 42 horizontal.Then, as shown in state K, when the automatic moving device 40 starts to decelerate and a deceleration detection signal is input from the acceleration sensor 48, the control unit 50 inclines the lift surface 42 by extending and retracting the front rod 421 and the rear rod 422 in a direction to cancel the inertial force, as shown in figure L, so that the baggage P does not slide in the moving direction of the automatic moving device due to the inertial force. Then, as shown in state M, when the automatic moving device 40 moves at a constant speed and the acceleration detection signal is no longer input from the acceleration sensor 48, the control unit 50 controls the lift device 43 so that the heights of the front and rear rods 421, 422 are the same, thereby horizontalizing the lift surface 42.

[0057] In the above-described embodiment, the automatic moving device 40 is configured as an AMR, but is not limited thereto. For example, it may be an AGV (Automatic Guided Vehicle), or may be a drone 80 capable of free flight as shown in FIG. 11. The drone 80 includes a control unit 81, a baggage gripping unit 82, a driving unit 86, and a communication unit 88. The control unit 81 controls the entire drone 80. The control unit 81 operates the baggage gripping unit 82, communicates with the management device 26 via the communication unit 88, and drives the driving unit 86. The baggage gripping unit 82 includes a pair of gripping arms and an operating mechanism for operating the gripping arms in a direction to approach or move away from each other, and is capable of gripping and releasing the grip of the baggage P by operating the gripping arms. The driving unit 86 includes a propeller for flight (not shown) and a motor for driving the propeller. The communication unit 88 wirelessly exchanges information with external devices such as the management device 26. In addition, the drone 80 is equipped with sensors (not shown) and a GPS receiver unit that receives signals from GPS satellites, and detects the inclination of the drone 80 while flying based on the detection signals of the sensors, estimates the drone's current position relative to the travel route R detected by the GPS receiver unit, and performs autopilot control based on the travel route R. In this case, it is possible to determine whether the state of the baggage P is stable or not based on a sudden change in the inclination or position of the drone 80 while the drone 80 is flying, and if it is determined that the baggage P is not stable, execute stabilization control to control the drive unit 86 so that the state of the baggage P is stabilized. [Industrial Applicability]

[0058] The mobile body of the present disclosure can be used in technical fields such as product distribution systems that deliver products. [Explanation of symbols]

[0059] 1 Mobile system, 13 Cargo platform, 20 Detection device, 21 First detection unit, 21a to 21i Pressure sensor, 22 Second detection unit, 22a to 22i Pressure sensor, 23 Third detection unit, 23a to 23i Pressure sensor, 24 Fourth detection unit, 24a to 24i Pressure sensor, 26 Management device, 27 Control device, 28 Memory unit, 29 Communication unit, 40 Automatic moving device, 40a Vehicle body, 41 Memory unit, 42 Lift surface, 43 Lift device, 44 Mecanum wheel, 45 Drive unit, 46 Distance measurement sensor, 47 Gyro sensor, 48 Acceleration sensor, 49 Communication unit, 50 Control unit, 80 Drone, 81 Control unit, 82 Luggage gripping unit, 86 Drive unit, 88 Communication unit, 421, 422 Rod, D Stabilization data, G Target position, H1, H2 M horizontal plane, P environmental map, P luggage, R movement path, S initial position, T1 uphill plane, T2 downhill plane.

Claims

1. A moving body having a holding device for holding luggage, A drive device that moves the moving body; a detection device that detects a parameter related to a stability degree of the luggage on the holding device while the moving body is moving; a control device that uses the parameter related to the stability degree to determine whether or not the state of the luggage is stable, and if it is determined that the state of the luggage is not stable, executes stabilization control to control the drive device so that the state of the luggage is stabilized; Equipped with The holding device has a platform for placing the luggage, the detection device includes a sensor that detects a position of the baggage on the platform as the parameter; the control device determines whether or not a state of the luggage is stable by detecting a change in the position of the luggage relative to the platform while the moving body is moving, and if it determines that the state of the luggage is not stable, controls the drive device in the stabilization control so that the position of the luggage does not change. Mobile body.

2. The moving body according to claim 1 , A storage device; an area estimation device that estimates an area in which the moving object is moving; Equipped with When the control device determines that the state of the luggage is unstable, the control device executes the stabilization control, and stores in the storage device an area in which the state of the luggage is unstable as a luggage unstable area. Mobile body.

3. The control device transmits the luggage unstable area stored in the storage device to a management device that manages the moving body or another moving body different from the moving body. The moving body according to claim 2.

4. When the control device determines that the state of the luggage is not stable, it executes the stabilization control, stores the executed stabilization control in the storage device in association with a luggage unstable area, which is an area where the state of the luggage is not stable, reads out from the storage device the stabilization control corresponding to the luggage unstable area before the moving body passes again through the luggage unstable area stored in the storage device, and executes the read stabilization control when the moving body passes through the luggage unstable area. The moving body according to claim 2.

5. The control device transmits the stabilization control stored in the storage device in association with the luggage unstable area to a management device that manages the moving body or to another moving body different from the moving body. The moving body according to claim 4.

Citation Information

Patent Citations

  • Traveling controller for unmanned carrier

    JP1992112214A

  • Cargo transportation robot

    JP2006123854A

  • Traveling vehicle system

    JP2008181245A

  • Determination method, determination device, and program

    JP2020158092A

  • Inverted two-wheel type carrier, and its control method

    WO2009028133A1