Attitude control device, attitude control method, and program
The attitude control device uses a propeller and control system to counteract swing and rotation of suspended loads, enhancing crane efficiency and safety by not adding weight, addressing the limitations of conventional devices.
Patent Information
- Application Number
- JP2023082741
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-19
- Publication Date
- 2024-11-29
AI Technical Summary
Conventional attitude control devices for suspended loads add weight to cranes, limiting the load capacity and often have insufficient braking force against rotation, especially when using gyroscopic effects.
An attitude control device with a propeller generating downward airflow, a turning section to adjust airflow direction, and a control system to detect and counteract rotation and sway of the suspended load, using sensors for precise control.
The device effectively suppresses swing and rotation of suspended loads without adding weight to the crane, allowing safer and more efficient crane operations.
Smart Images

Figure 2024166562000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to an attitude control device, an attitude control method, and a program. [Background technology]
[0002] When a load suspended by a crane is rotated or when wind blows, the load will sway. Workers need to pull the suspension rope attached to the load to suppress the load's sway. However, once the load starts to sway, it is time-consuming and laborious to manually stop the load and move it to an appropriate position. In addition, if the load sways significantly due to a sudden gust of wind, the load may come into contact with the worker.
[0003] Therefore, methods for automatically suppressing the swing of a suspended load have been devised. For example, Patent Document 1 describes a technology in which a load is suspended from a crane via an attitude control device, and the attitude control device generates a horizontal thrust using a thruster to suppress the swing of the load. Patent Document 2 describes an attitude control device that suppresses the rotation of the suspended load by using the gyro effect. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2022-94983 A [Patent Document 2] JP 2019-151470 A Summary of the Invention [Problem to be solved by the invention]
[0005] However, in conventional attitude control devices, the weight of the device itself is added to the crane, which limits the weight of the load that the crane can suspend. Also, attitude control devices that utilize the gyro effect are heavy due to the incorporation of a flywheel or the like, and the braking force against the rotation of the load is small.
[0006] An object of the present disclosure is to provide an attitude control device, an attitude control method, and a program that can control the sway and rotation of a suspended load while suppressing the weight of the device itself from being added to the crane. [Means for solving the problem]
[0007] According to one aspect of the present disclosure, the posture control device is a posture control device for a load of a crane, and includes a load holding section that holds the load, a propeller attached to the load holding section and rotating blades around a rotation axis extending in the vertical direction to generate an airflow that flows vertically downward, a turning section that turns the airflow generated by the propeller, and a control section that controls the orientation of the turning section, wherein the control section includes a rotation detection section that detects whether or not the load is rotating, a rotation control section that changes the orientation of the turning section when rotation of the load is detected so that the flow direction of the airflow tilts forward in the direction of rotation of the load, a lateral sway detection section that detects whether or not the load is swaying horizontally, and a lateral sway control section that changes the orientation of the turning section when sway of the load is detected so that the flow direction of the airflow tilts forward in the direction of sway of the load.
[0008] According to one aspect of the present disclosure, the posture control device is a posture control device for a load of a crane, and includes a thruster that rotates blades around a rotation axis extending in the vertical direction to generate an airflow that flows vertically downward, a fixing jig that detachably fixes the thruster to the load, a turning unit that turns the airflow generated by the thruster, and a control unit that controls the orientation of the turning unit, wherein the control unit has a rotation detection unit that detects whether or not the load is rotating, a rotation control unit that changes the orientation of the turning unit so that the flow direction of the airflow tilts forward in the direction of rotation of the load when rotation of the load is detected, a lateral sway detection unit that detects whether or not the load is swaying horizontally, and a lateral sway control unit that changes the orientation of the turning unit so that the flow direction of the airflow tilts forward in the direction of sway of the load when sway of the load is detected.
[0009] According to one aspect of the present disclosure, a posture control method is a method for controlling the posture of a load using a posture control device including a load holding part for holding a load of a crane, a propeller attached to the load holding part and rotating blades about a rotation axis extending in the vertical direction to generate an airflow that flows vertically downward, a turning part for turning the airflow generated by the propeller, and a control part for controlling the orientation of the turning part, the method including the steps of: detecting whether or not the load is rotating by the posture control device; when rotation of the load is detected, changing the orientation of the turning part so that the flow direction of the airflow tilts forward in the direction of rotation of the load; detecting whether or not the load is swaying in the horizontal direction by the posture control device; and when swaying of the load is detected, changing the orientation of the turning part so that the flow direction of the airflow tilts forward in the direction of swaying of the load.
[0010] According to one aspect of the present disclosure, the program causes an attitude control device including a load holding part for holding a load of a crane, a propeller attached to the load holding part and rotating blades around a rotation axis extending in the vertical direction to generate an airflow that flows vertically downward, a turning part for turning the airflow generated by the propeller, and a control part for controlling the orientation of the turning part to execute the following steps: detecting whether or not the load is rotating; when rotation of the load is detected, changing the orientation of the turning part so that the flow direction of the airflow tilts forward in the direction of rotation of the load; detecting whether or not the load is swaying in the horizontal direction; and when swaying of the load is detected, changing the orientation of the turning part so that the flow direction of the airflow tilts forward in the direction of swaying of the load. Effect of the Invention
[0011] According to the above aspect, it is possible to control the swing and rotation of the suspended load while preventing the weight of the device itself from being added to the crane. [Brief description of the drawings]
[0012] [Figure 1]1 is a schematic diagram showing an overall configuration of a posture control device according to a first embodiment. [Diagram 2] FIG. 1 is a plan view showing a configuration of a posture control device according to a first embodiment. [Diagram 3] FIG. 3 is a cross-sectional view taken along line II-II in FIG. [Figure 4] FIG. 2 is a plan view showing a first modified example of the attitude control device of the first embodiment. [Diagram 5] FIG. 4 is a plan view showing a second modified example of the attitude control device of the first embodiment. [Figure 6] 3 is a block diagram showing a functional configuration of a control unit according to the first embodiment. FIG. [Figure 7] 4 is a flowchart for explaining the flow of an attitude control method performed by the attitude control device according to the first embodiment. [Figure 8] FIG. 2 is a diagram for explaining rotation control according to the first embodiment. [Figure 9] FIG. 2 is a diagram for explaining lateral oscillation control according to the first embodiment. [Figure 10] FIG. 11 is a plan view showing a configuration of an attitude control device according to a second embodiment. [Figure 11] FIG. 11 is a plan view showing a modified example of the attitude control device of the second embodiment. [Figure 12] FIG. 11 is a side view showing the configuration of an attitude control device according to a third embodiment. [Figure 13] FIG. 11 is a plan view showing the configuration of an attitude control device according to a third embodiment. [Figure 14] FIG. 13 is a plan view showing a modified example of the attitude control device of the third embodiment. [Figure 15] FIG. 13 is a side view showing the configuration of an attitude control device according to a fourth embodiment. [Figure 16] 13A and 13B are schematic diagrams illustrating modified examples of a turning portion according to at least one embodiment. [Figure 17] 1 is a schematic block diagram showing a hardware configuration of a control unit of an attitude control device according to at least one embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0013] <First embodiment> The first embodiment will be described in detail below with reference to FIGS. FIG. 1 is a schematic diagram showing the overall configuration of a posture control device according to a first embodiment. The posture control device 1 is a device for suppressing rotation and lateral vibration of a load 9 of the crane and controlling the load 9 to take a target posture (position and direction). The posture control device 1 is suspended from a hook H at the tip of the crane by a wire W1. The load 9 is suspended from the posture control device 1 by a wire W2.
[0014] (Structure of attitude control device) Fig. 2 is a plan view showing the configuration of the attitude control device according to the first embodiment, Fig. 3 is a cross-sectional view taken along line II-II in Fig. 2. As shown in FIGS. 2 and 3, the attitude control device 1 includes a hanging jig 10 (a load holding unit), a thruster 20, a turning unit 24, a manifold 25, and a control unit 30.
[0015] The hoisting jig 10 has a rectangular shape in a plan view as shown in Fig. 2. The hoisting jig 10 has a built-in battery (not shown) and the like. A wire W1 (Fig. 1) for suspending the posture control device 1 is connected to a hook H at the tip of a crane, and a wire W2 (Fig. 1) for suspending a load 9 is also connected to the hoisting jig 10. The hoisting jig 10 functions as a load holding section that suspends and holds the load 9.
[0016] Further, a plurality of holes 11 are formed in the hanging jig 10, penetrating it in the vertical direction. As shown in Fig. 2, at least one hole 11 is formed on each side of the hanging jig 10. The holes 11 are formed in a rectangular shape (slit shape) with the long sides extending in a direction perpendicular to each side in a plan view, and are arranged radially (in a cross shape) with the center of gravity G of the hanging jig 10 as the center, as in the example of Fig. 2.
[0017] FIG. 4 is a plan view showing a first modified example of the attitude control device of the first embodiment. The hanging jig 10 may have two holes 11 formed on each side as shown in Fig. 4. Furthermore, the number of holes 11 may be any multiple of four, and three or more holes 11 may be formed on each side.
[0018] The propeller 20 is provided in an area including the center of gravity G of the hanging jig 10. The propeller 20 is a ducted fan as shown in FIG.
[0019] The electric motor 21 and the blades 22 are provided on the lower end side and the upper end side, respectively, of a rotating shaft 21a extending vertically along the axis X. When electric motor 21 is supplied with power from a battery built into the hanging jig 10, it drives and rotates the blades 22 via the rotating shaft 21a. Note that in other embodiments, electric motor 21 may be supplied with power not from the battery built into the hanging jig 10 but from an external power supply device, for example, via a power cable arranged along the wire W2.
[0020] The blades 22 generate a vertically downward airflow by rotating around the rotation axis 21a. The thruster 20 generates a thrust (buoyancy) that raises the attitude control device 1 vertically by reacting to this downward airflow. In the flow direction of the airflow, the side where the airflow flows away is also referred to as the "downstream side" and the opposite side as the "upstream side". Note that, although an example in which the thruster 20 has two blades 22 is shown in FIG. 2, this is not limiting. In other embodiments, the thruster 20 may have three or more blades 22.
[0021] Duct 23 is formed in a cylindrical shape extending in the vertical direction, and is disposed so as to cover the outer periphery of motor 21 and blades 22. The inside of duct 23 becomes a flow path for the airflow generated by the rotation of blades 22.
[0022] In this embodiment, an example in which the thruster 20 is a ducted fan will be described, but the present invention is not limited to this. In other embodiments, the thruster 20 may be a propeller, a thruster that ejects high-pressure gas, or the like.
[0023] FIG. 5 is a plan view showing a second modified example of the attitude control device of the first embodiment. As shown in Fig. 5, the attitude control device 1 may include multiple (for example, four) thrusters 20. In the example of Fig. 5, the thrusters 20 are evenly arranged around the center of gravity G of the hanging jig 10. The airflow generated by each thruster 20 is introduced into each hole 11 formed on all four sides of the hanging jig 10 through a manifold 25.
[0024] As shown in FIG. 3, the manifold 25 is connected to the lower end of the propeller 20 (duct 23) in the vertical direction. The manifold 25 is a support that supports the propeller 20 on the upper part of the hanging jig 10. The manifold 25 is hollow inside, and splits the airflow that has passed through the duct 23 into multiple different directions and introduces the airflow into each of the multiple holes 11 of the hanging jig 10. As in the example of FIG. 2, when four holes 11 are formed in the hanging jig 10, the manifold 25 branches into four and is connected to each hole 11. The airflow generated by the propeller 20 passes through the manifold 25 and the multiple holes 11, and is dispersed and ejected downward in the vertical direction of the hanging jig 10.
[0025] When eight holes 11 (two on each side) are formed as in the example of FIG. 4, manifold 25 branches into eight paths corresponding to holes 11. As shown in FIG.
[0026] The deflecting portion 24 is provided at the outlet (vertical lower end) of each of the plurality of holes 11, and deflects the airflow ejected from the holes 11 to change the thrust direction.
[0027] The deflection unit 24 has a plate-shaped portion 24a and an actuator 24c. The plate-shaped portion 24a is rotatable around a rotation axis Y extending in the horizontal direction (direction perpendicular to the X-axis) and is a flat louver or flap that spreads vertically downward from the rotation axis Y. One plate-shaped portion 24a is provided for each hole 11 of the hanging jig 10. The actuator 24c rotates the plate-shaped portion 24a around the rotation axis Y under the control of a control unit 30 described later. The deflection unit 24 can deflect the direction of the airflow ejected from the hole 11 along the plate-shaped portion 24a by rotating and tilting the plate-shaped portion 24a. The plate-shaped portions 24a can rotate in different directions at different angles.
[0028] The control unit 30 is fixed to the upper surface of the hanging jig 10 as shown in Fig. 3. The control unit 30 detects rotation and vibration of the suspended load 9, and controls the direction of the thrust generated by the thruster 20 to suppress the detected rotation and vibration.
[0029] (Functional configuration of the control unit) FIG. 6 is a block diagram showing a functional configuration of the control unit according to the first embodiment. As shown in FIG. 6, the control unit 30 includes a gyro sensor 301, an acceleration sensor 302, a first auxiliary sensor 303, a second auxiliary sensor 304, a communication processing unit 305, a rotation detection unit 306, a rotation control unit 307, a lateral shaking detection unit 308, and a lateral shaking control unit 309.
[0030] The gyro sensor 301 measures an inclination angle capable of detecting the attitude of the hanging jig 10 and an angular acceleration capable of detecting rotation.
[0031] The acceleration sensor 302 measures an acceleration capable of detecting the lateral swing of the hanging jig 10 .
[0032] In this embodiment, the first auxiliary sensor 303 is a magnetic sensor. The first auxiliary sensor 303 (magnetic sensor) detects the orientation of the hanging jig 10 by measuring the direction of the geomagnetism.
[0033] In this embodiment, the second auxiliary sensor 304 is a positioning sensor that uses a Global Navigation Satellite System (GNSS). The second auxiliary sensor 304 (positioning sensor) measures the absolute position (movement, longitude) of the hanging jig 10 based on the received satellite signal.
[0034] The communication processing unit 305 transmits and receives information, signals, and the like used for controlling the posture of the suspended load 9 to and from an external device. The external device is, for example, a crane control device, a terminal for a crane operator to remotely control the posture control device 1, and the like. In this embodiment, the communication processing unit 305 acquires a crane stop signal from the external device, which indicates that the operation of the crane (movement and rotation of the suspended load 9) has stopped. The control unit 30 starts controlling the posture of the suspended load 9 using the reception of the crane stop signal as a trigger.
[0035] The rotation detection unit 306 detects the rotation of the suspending jig 10 and the presence or absence of the rotation of the load 9 suspended from the suspending jig 10 based on the measurement value of the gyro sensor 301 .
[0036] When rotation of the suspended load 9 is detected, the rotation control unit 307 changes the orientation of the turning unit 24 (plate-shaped unit 24a) so that the flow direction of the airflow is tilted forward in the direction of rotation of the posture control device 1.
[0037] The lateral vibration detection unit 308 detects the presence or absence of lateral vibration of the suspending jig 10 and the load 9 suspended from the suspending jig 10 based on the measurement value of the acceleration sensor 302 .
[0038] When lateral swaying of the suspended load 9 is detected, the lateral sway control unit 309 changes the orientation of the turning unit 24 (plate-shaped unit 24a) so that the flow direction of the airflow is tilted forward in the swaying direction of the posture control device 1.
[0039] (Attitude control method using an attitude control device) FIG. 7 is a flowchart for explaining the flow of the attitude control method performed by the attitude control device according to the first embodiment. The crane operator suspends the posture control device 1 from the hook H of the crane, and with the load 9 suspended from the hoisting jig 10 of the posture control device 1, uses the crane to hoist the load 9. When hoisting of the load 9 is complete, the operator performs an operation to stop the crane. When the crane control device stops the operation of the crane, it transmits a crane stop signal to the control unit 30 of the posture control device 1. Alternatively, the operator may perform an operation to transmit a crane stop signal to the control unit 30 of the posture control device 1 through a terminal device. When the communication processing unit 305 of the control unit 30 receives this crane stop signal (step S01), the control unit 30 starts posture control of the load 9.
[0040] First, the rotation detection unit 306 detects the presence or absence of yaw rotation of the suspended load 9 (step S02).
[0041] For example, the rotation detection unit 306 calculates the azimuth deviation (yaw angle) of the load 9 from the target attitude (target direction) based on the measurement value of the gyro sensor 301. If the calculated azimuth deviation is equal to or greater than a predetermined angle threshold, the rotation detection unit 306 determines that the load 9 is rotating. The target attitude is, for example, the initial attitude of the load 9 at the start of attitude control (when the crane stop signal is received). Furthermore, the rotation detection unit 306 may correct the calculated azimuth deviation based on the direction of the load 9 detected by the first auxiliary sensor 303 (magnetic sensor).
[0042] In addition, in other embodiments, the rotation detection unit 306 may obtain the target attitude of the load 9 from an external device via the communication processing unit 305, and calculate the azimuth deviation of the load 9 from the target attitude based on the measurement value of the gyro sensor 301 and the orientation of the load 9 detected by the first auxiliary sensor 303.
[0043] When the rotation detection unit 306 detects the yaw rotation of the suspended load 9 (step S02; YES), the rotation control unit 307 executes the rotation control of the suspended load 9 (step S03).
[0044] FIG. 8 is a diagram for explaining the rotation control according to the first embodiment. For example, as shown in Fig. 8, assume that the hoisting jig 10 and the load 9 are rotating in the rotation direction Dr indicated by the dashed arrow. In this case, the rotation control unit 307 controls the plate-shaped parts 24a of all the turning units 24 to rotate by the same angle toward the front side of the rotation direction Dr. At this time, the rotation control unit 307 adjusts the angle at which the plate-shaped parts 24a are rotated according to the magnitude of the azimuth deviation. As a result, the flow direction Dfl of the airflow generated by the propeller 20 is turned so as to tilt toward the front side of the rotation direction Dr, and a thrust is generated in the opposite direction to the rotation direction Dr (thrust direction Dth indicated by the solid arrow) as a reaction to the airflow. This thrust suppresses the rotation of the load 9.
[0045] Furthermore, after executing the rotation control in step S03, the control unit 30 returns to step S02 again to check whether the yaw rotation of the suspended load 9 has settled. If the yaw rotation has not settled (step S02; YES), the control unit 30 executes the rotation control again (step S03). That is, the control unit 30 repeatedly executes steps S02 to S03 until the rotation detection unit 306 no longer detects the yaw rotation (the azimuth deviation becomes less than the predetermined angle threshold).
[0046] Next, if the rotation detection unit 306 does not detect a yaw rotation (step S02; NO), the lateral oscillation detection unit 308 detects the presence or absence of lateral oscillation of the suspended load 9 (step S04).
[0047] For example, the lateral sway detection unit 308 calculates the horizontal position error of the load 9 relative to the target attitude (target position) based on the measurement value of the acceleration sensor 302. If the calculated position error is equal to or greater than a predetermined error threshold, the lateral sway detection unit 308 determines that the load 9 is swaying. The target attitude is, for example, the initial attitude of the load 9 at the start of attitude control (when the crane stop signal is received). In addition, the lateral sway detection unit 308 may correct the calculated position error based on the measurement value (tilt angle) of the gyro sensor 301 or the absolute position of the load 9 detected by the second auxiliary sensor 304 (positioning sensor).
[0048] In addition, in other embodiments, the lateral sway detection unit 308 may obtain the target attitude of the load 9 from an external device via the communication processing unit 305, and calculate the current sway direction and position error of the load 9 relative to the target attitude based on the measurement value of the acceleration sensor 302 and the absolute position of the load 9 detected by the second auxiliary sensor 304.
[0049] When the lateral oscillation detection unit 308 detects lateral oscillation of the suspended load 9 (step S04; YES), the lateral oscillation control unit 309 executes position control of the suspended load 9 (step S05).
[0050] FIG. 9 is a diagram for explaining the lateral oscillation control according to the first embodiment. For example, as shown in FIG. 9, it is assumed that the hoisting jig 10 and the suspended load 9 are swaying in the swaying direction Ds indicated by the dashed arrow. In this case, the lateral sway control unit 309 controls the plate-shaped portion 24a of the turning unit 24, which is rotatable in the swaying direction Ds, to rotate toward the front side of the swaying direction Ds. In the example of FIG. 9, the plate-shaped portions 24a arranged at the top and bottom of the paper are rotated so as to tilt forward (to the right side of the paper) in the swaying direction Ds. At this time, the lateral sway control unit 309 adjusts the angle at which each plate-shaped portion 24a is rotated according to the direction of the sway and the magnitude of the position error. Then, the flow direction Dfl of the airflow generated by the propeller 20 is turned so as to tilt forward in the swaying direction Ds, and a thrust is generated in the opposite direction to the swaying direction Ds (thrust direction Dth indicated by the solid arrow) as a reaction to the flow of the airflow. This thrust suppresses the lateral swaying of the suspended load 9.
[0051] Furthermore, after executing the position control in step S05, the control unit 30 returns to step S04 again to check whether the lateral shaking of the suspended load 9 has stopped. If the lateral shaking has not stopped (step S04; YES), the control unit 30 executes the position control again (step S05). That is, the control unit 30 repeatedly executes steps S04 to S05 until the lateral shaking detection unit 308 no longer detects the lateral shaking (the position error becomes less than a predetermined error threshold).
[0052] Next, if the lateral oscillation detection unit 308 does not detect lateral oscillation (step S06; NO), the control unit 30 fixes the orientation of the plate-shaped portion 24a of the turning unit 24 (step S06).
[0053] It should be noted that the crane may be operated again after the posture of the load 9 has stabilized. For example, when the crane control device receives a crane operation from an operator, it transmits an end signal for posture control to the control unit 30 of the posture control device 1. The operator may also perform an operation to transmit an end signal to the control unit 30 of the posture control device 1 through a terminal device. When the communication processing unit 305 of the control unit 30 receives this end signal (step S07; YES), the control unit 30 terminates the posture control of the load 9. On the other hand, when the control unit 30 does not receive an end signal (step S07; NO), it returns to step S02 and continues to execute a series of processes for posture control of the load 9.
[0054] The control unit 30 of the posture control device 1 executes a series of processes shown in FIG. 7 every time it receives a crane stop signal.
[0055] (Action, effect) As described above, the posture control device 1 according to this embodiment includes the hanging jig 10 that holds the load 9, the propeller 20 that is attached to the hanging jig 10 and rotates the blades 22 around the rotation axis 21a extending in the vertical direction to generate an airflow that flows vertically downward, the deflection unit 24 that deflects the airflow generated by the propeller 20, and the control unit 30 that controls the orientation of the deflection unit 24. The control unit 30 includes a rotation detection unit 306 that detects whether or not the load 9 is rotating, a rotation control unit 307 that changes the orientation of the deflection unit 24 so that the flow direction of the airflow tilts forward in the rotation direction Dr of the load 9 when rotation of the load 9 is detected, a lateral swing detection unit 308 that detects whether or not the load 9 is swaying in the horizontal direction, and a lateral swing control unit 309 that changes the orientation of the deflection unit 24 so that the flow direction of the airflow tilts forward in the swing direction of the load 9 when swing of the load 9 is detected.
[0056] In this way, the attitude control device 1 can obtain a vertically upward thrust, i.e., buoyancy, from the propeller 20, and can suppress limitations on the weight of the load 9 that the crane can suspend due to the weight of the attitude control device 1 itself. In addition, the attitude control device 1 can change the direction of the thrust to suppress rotation and lateral shaking of the load 9. This allows the operator to carry out crane work safely and efficiently.
[0057] The attitude control device 1 also includes a manifold 25 that is connected to the lower end of the thruster 20 in the vertical direction and supports the thruster 20 on the upper part of the hanging jig 10. The hanging jig 10 is a rectangular member that suspends and holds the load 9, and has a plurality of holes 11 formed in each of the four peripheral edges, at least one of which penetrates in the vertical direction. The manifold 25 splits the airflow generated by the thruster 20 into a plurality of different directions and introduces it into each of the holes 11, and the turning section 24 is provided at the outlet of the hole 11 of the hanging jig 10.
[0058] By doing this, even if the attitude control device 1 has a simple configuration, for example having only one thruster 20, it is possible to distribute the airflow generated by the thruster 20 and suppress rotation and lateral swaying of the suspended load 9.
[0059] The control unit 30 also includes a gyro sensor 301 and a first auxiliary sensor 303 which is a magnetic sensor. The rotation detection unit 306 calculates an orientation deviation from a target attitude of the load 9 based on a measurement value of the gyro sensor 301, and corrects the orientation deviation based on a measurement value of the first auxiliary sensor 303.
[0060] By doing this, the posture control device 1 can correct the cumulative error in the orientation deviation (yaw angle) detected by the gyro sensor 301 using the orientation of the load 9 detected by the first auxiliary sensor 303 (magnetic sensor), thereby more accurately suppressing rotation of the load 9.
[0061] The control unit 30 also includes an acceleration sensor 302 and a second auxiliary sensor 304 which is a positioning sensor. The lateral oscillation detection unit 308 calculates a position error with respect to the target attitude of the load 9 based on the measurement value of the acceleration sensor 302, and corrects the position error based on the measurement value of the second auxiliary sensor 304.
[0062] By doing this, the posture control device 1 can correct the cumulative error of the position error caused by the acceleration sensor 302 using the absolute position of the load 9 detected by the second auxiliary sensor 304 (positioning sensor), thereby more accurately suppressing the lateral swaying of the load 9.
[0063] <Modification 1 of the First Embodiment> In the above-mentioned first embodiment, an example in which the first auxiliary sensor 303 is a magnetic sensor has been described, but the present invention is not limited to this. In other embodiments, the first auxiliary sensor 303 may be a camera. In this case, the rotation detection unit 306 detects whether the load 9 is rotating and the direction in which the load 9 is facing by applying known image processing to an image captured by the camera. The rotation detection unit 306 estimates an orientation deviation from the detected direction in which the load 9 is facing, or corrects the orientation deviation based on the measurement value of the gyro sensor 301.
[0064] In this way, the posture control device 1 can precisely detect the azimuth deviation of the suspended load 9, and therefore can suppress the rotation of the suspended load 9 with greater precision.
[0065] <Modification 2 of the First Embodiment> In the above-described first embodiment, an example in which the second auxiliary sensor 304 is a positioning sensor has been described, but the present invention is not limited to this. In other embodiments, the second auxiliary sensor 304 may be a distance measuring sensor (such as a laser sensor or an ultrasonic sensor) that measures the distance between the hoisting jig 10 (suspended load 9) and surrounding objects (such as a crane or a building), or a camera.
[0066] When the second auxiliary sensor 304 is a distance measurement sensor, the lateral sway detection unit 308 estimates whether the load 9 is swaying laterally and the position of the load 9 from the change in the distance between the load 9 and surrounding objects.
[0067] In addition, when the second auxiliary sensor 304 is a camera, the lateral sway detection unit 308 performs known image processing on the image captured by the camera to estimate whether the load 9 is swaying laterally and the position of the load 9.
[0068] The lateral shaking detection unit 308 estimates a position error based on the position of the suspended load 9 estimated from the measurement value of the second auxiliary sensor 304 , or corrects the position error based on the measurement value of the acceleration sensor 302 .
[0069] <Second embodiment> Next, a second embodiment will be described with reference to Figures 10 and 11. Components common to the above-mentioned embodiment will be given the same reference numerals and detailed description will be omitted.
[0070] FIG. 10 is a plan view showing the configuration of the attitude control device according to the second embodiment. 10, the attitude control device 1 according to this embodiment does not have a manifold 25, and at least one thruster 20 is attached to each of the four outer surfaces of the hanging jig 10. Moreover, in this embodiment, the hanging jig 10 does not have a hole 11.
[0071] FIG. 11 is a plan view showing a modification of the attitude control device of the second embodiment. As shown in FIG. 11, the posture control device 1 may have a plurality of (for example, two each) thrusters 20 attached to one outer surface of the hanging jig .
[0072] One turning section 24 is provided for each of the propellers 20.
[0073] The attitude control device 1 according to this embodiment can be configured to be lightweight and compact by eliminating the manifold 25 and attaching the thrusters 20 to the outer surface of the hanging jig 10. Even with this configuration, the same effects as those of the first embodiment can be obtained.
[0074] <Third embodiment> Next, a third embodiment will be described with reference to Figures 12 to 14. Components common to the above-described embodiments are given the same reference numerals and detailed description will be omitted.
[0075] FIG. 12 is a side view showing the configuration of the attitude control device according to the third embodiment. 12, the posture control device 1 according to this embodiment includes a container 12 instead of the hoisting jig 10. The container 12 has a rectangular parallelepiped shape, and functions as a load holding section that houses and holds a load 9 therein.
[0076] FIG. 13 is a plan view showing the configuration of the attitude control device according to the third embodiment. As shown in FIGS. 12 and 13, at least one thruster 20 is provided on each of the four outer surfaces of the container 12.
[0077] FIG. 14 is a plan view showing a modification of the attitude control device of the third embodiment. As shown in FIG. 14, the attitude control device 1 may have a plurality of (for example, two each) thrusters 20 attached to one outer surface of the container 12.
[0078] One turning section 24 is provided for each of the propellers 20.
[0079] 12, the control unit 30 is provided in one of the connection units 13 that connect the container 12 and the thruster 20. The functional configuration of the control unit 30 is similar to that of the first embodiment.
[0080] In the above-described embodiment, the attitude control device 1 suspends the load 9 by the wire W2. Therefore, it was necessary to take into consideration the swinging of the wire W2. In contrast, the attitude control device 1 according to this embodiment has a configuration in which a container 12 capable of accommodating the load 9 therein and a thruster 20 is attached to the outer surface of the container 12. This allows the attitude control device 1 to directly suppress the rotation and lateral swing of the load 9 without being affected by the swinging of the wire W2. Therefore, the attitude control device 1 can stabilize the load 9 more effectively. Furthermore, the airflow ejected from the thruster 20 does not collide with the load 9, so the load 9 can be more stabilized.
[0081] <Fourth embodiment> Next, a fourth embodiment will be described with reference to Fig. 15. Components common to the above-mentioned embodiments are given the same reference numerals and detailed description will be omitted.
[0082] FIG. 15 is a side view showing the configuration of the attitude control device according to the fourth embodiment. The attitude control device 1 according to the third embodiment described above is configured to include a container 12, and to have the propellers 20 attached to the outer surface of the container 12. In contrast, in this embodiment, the attitude control device 1 does not include the container 12, and is equipped with a fixing jig that detachably fixes the propellers 20 to the outer surface of the suspended load 9. At least one propeller 20 is attached to each of the four outer surfaces of the suspended load by the fixing jig 14. The number of propellers 20 is the same as in the third embodiment.
[0083] One turning section 24 is provided for each of the propellers 20.
[0084] The control unit 30 is provided in one of the fixing jigs 14 that connect the load 9 and the thruster 20. The functional configuration of the control unit 30 is similar to that of the first embodiment.
[0085] As described above, the attitude control device 1 according to this embodiment has the thruster 20 directly attached to the outer surface of the suspended load 9 by the fixing jig 14. In this manner, the attitude control device 1 can directly suppress the rotation and lateral shaking of the suspended load 9 without being affected by the swinging of the wire W2. Therefore, the attitude control device 1 can more effectively stabilize the suspended load 9. Furthermore, since the airflow ejected from the thruster 20 does not collide with the suspended load 9, the suspended load 9 can be further stabilized.
[0086] Furthermore, by directly attaching the thrusters 20 to the outer surface of the load 9, the attitude control device 1 can be flexibly applied to various loads 9 having different sizes and shapes.
[0087] <Other embodiments> Although one embodiment has been described in detail above with reference to the drawings, the specific configuration is not limited to the above, and various design changes are possible. That is, in other embodiments, the order of the above-mentioned processes may be changed as appropriate. Also, some of the processes may be executed in parallel.
[0088] In addition, in each of the above-mentioned embodiments, the configuration in which the turning portion 24 has the plate-shaped portion 24a has been described, but the present invention is not limited to this. The turning portion 24 according to other embodiments may have a nozzle 24b instead of the plate-shaped portion 24a, as shown in FIG. 16, for example. The nozzle 24b is tubular, and a flow path through which the airflow can flow is formed inside. The nozzle 24b is rotated by the actuator 24c, and the direction in which the airflow is ejected can be changed. The nozzle 24b may be formed of an elastically deformable material.
[0089] <Hardware configuration of the control unit of the attitude control device> FIG. 17 is a schematic block diagram showing a hardware configuration of a control unit of the attitude control device according to at least one embodiment.
[0090] The computer 900 comprises a processor 901 , a main memory device 902 , an auxiliary memory device 903 , and an interface 904 .
[0091] The above-mentioned control unit 30 is implemented in a computer 900. The operations of the above-mentioned processing units are stored in the auxiliary storage device 903 in the form of a program. The processor 901 reads the program from the auxiliary storage device 903, loads it in the main storage device 902, and executes the above-mentioned processing in accordance with the program. The processor 901 also secures storage areas in the main storage device 902 corresponding to the above-mentioned storage units in accordance with the program.
[0092] The program may be for realizing a part of the functions to be performed by the computer 900. For example, the program may be for realizing the functions by combining with other programs already stored in the auxiliary storage device 903 or by combining with other programs implemented in other devices. In another embodiment, the computer 900 may include a custom LSI (Large Scale Integrated Circuit) such as a PLD (Programmable Logic Device) in addition to or instead of the above configuration. Examples of PLDs include PAL (Programmable Array Logic), GAL (Generic Array Logic), CPLD (Complex Programmable Logic Device), and FPGA (Field Programmable Gate Array). In this case, some or all of the functions to be realized by the processor 901 may be realized by the integrated circuit.
[0093] Examples of the auxiliary storage device 903 include a hard disk drive (HDD), a solid state drive (SSD), a magnetic disk, a magneto-optical disk, a compact disc read only memory (CD-ROM), a digital versatile disc read only memory (DVD-ROM), and a semiconductor memory. The auxiliary storage device 903 may be an internal medium directly connected to the bus of the computer 900, or an external storage device 910 connected to the computer 900 via an interface 904 or a communication line. In addition, when the program is distributed to the computer 900 via a communication line, the computer 900 that receives the program may load the program into the main storage device 902 and execute the above-mentioned process. In at least one embodiment, the auxiliary storage device 903 is a non-transitory tangible storage medium.
[0094] The program may be for realizing part of the above-mentioned functions. Furthermore, the program may be a so-called differential file (differential program) that realizes the above-mentioned functions in combination with another program already stored in the auxiliary storage device 903.
[0095] <Additional Notes> The attitude control device, attitude control method, and program described in the above-described embodiments can be understood, for example, as follows.
[0096] (1) According to the first aspect, the posture control device 1 for a load 9 of a crane includes load holding units 10, 12 that hold the load 9, a propeller 20 that is attached to the load holding units 10, 12 and rotates a blade 22 around a rotation axis 21a extending in the vertical direction to generate an airflow that flows vertically downward, a deflection unit 24 that deflects the airflow generated by the propeller 20, and a control unit 30 that controls the orientation of the deflection unit 24. The control unit 30 includes a rotation detection unit 306 that detects whether or not the load 9 is rotating, a rotation control unit 307 that changes the orientation of the deflection unit 24 so that the flow direction of the airflow tilts forward in the rotation direction Dr of the load when rotation of the load 9 is detected, a lateral sway detection unit 308 that detects whether or not the load 9 is swaying in the horizontal direction, and a lateral sway control unit 309 that changes the orientation of the deflection unit 24 so that the flow direction of the airflow tilts forward in the sway direction Ds of the load 9 when sway of the load 9 is detected.
[0097] In this way, the attitude control device 1 can obtain a vertically upward thrust, i.e., buoyancy, from the propeller 20, and can suppress limitations on the weight of the load 9 that the crane can suspend due to the weight of the attitude control device 1 itself. In addition, the attitude control device 1 can change the direction of the thrust to suppress rotation and lateral shaking of the load 9. This allows the operator to carry out crane work safely and efficiently.
[0098] (2) According to a second aspect, in the attitude control device 1 according to the first aspect, the control unit 30 further includes a gyro sensor 301 and a first auxiliary sensor 303 which is a magnetic sensor or a camera. The rotation detection unit 306 calculates an orientation deviation from a target attitude of the load 9 based on a measurement value of the gyro sensor 301, and corrects the orientation deviation based on a measurement value of the first auxiliary sensor 303.
[0099] By doing this, the posture control device 1 can correct the cumulative error in the orientation deviation (yaw angle) detected by the gyro sensor 301 using the orientation of the load 9 detected by the first auxiliary sensor 303, thereby more accurately suppressing rotation of the load 9.
[0100] (3) According to a third aspect, in the attitude control device 1 according to the first or second aspect, the control unit 30 further has an acceleration sensor 302 and a second auxiliary sensor 304 which is a positioning sensor, a distance measuring sensor, or a camera. The lateral oscillation detection unit 308 calculates a position error with respect to the target attitude of the load 9 based on the measurement value of the acceleration sensor 302, and corrects the position error based on the measurement value of the second auxiliary sensor 304.
[0101] By doing this, the posture control device 1 can correct the cumulative error of the position error caused by the acceleration sensor 302 using the absolute position of the load 9 detected by the second auxiliary sensor 304, thereby more accurately suppressing the lateral swaying of the load 9.
[0102] (4) According to a fourth aspect, the attitude control device 1 according to any one of the first to third aspects further includes a manifold 25 connected to the lower vertical end of the thruster 20 and supporting the thruster 20 on the upper part of the load holding part 10. The load holding part 10 is a rectangular member that suspends and holds a load 9, and has at least one hole 11 formed on each of its four sides that penetrates in the vertical direction. The manifold 25 splits the airflow generated by the thruster 20 into a plurality of different directions and introduces it into each of the holes 11. The turning part 24 is provided at the exit of the hole 11 of the load holding part 10.
[0103] By doing this, even if the attitude control device 1 has a simple configuration, for example having only one thruster 20, it is possible to distribute the airflow generated by the thruster 20 and suppress rotation and lateral swaying of the suspended load 9.
[0104] (5) According to the fifth aspect, in the attitude control device 1 relating to any one of the first to third aspects, the load holding parts 10, 12 are rectangular members (suspension jig 10) that suspend and hold the load 9, or a rectangular parallelepiped container 12 that houses and holds the load 9 therein, and at least one thruster 20 is attached to each of the four outer surfaces of the load holding parts 10, 12, and one turning part 24 is provided vertically below each thruster 20.
[0105] By doing this, unlike a case where the attitude control device 1 and the suspended load 9 are connected by the wire W2, the attitude control device 1 can directly suppress the rotation and lateral shaking of the suspended load 9 without being affected by the swinging of the wire W2. Therefore, the attitude control device 1 can more effectively stabilize the suspended load 9. Furthermore, since the airflow ejected from the thruster 20 does not collide with the suspended load 9, the suspended load 9 can be further stabilized.
[0106] (6) According to the sixth aspect, in the attitude control device 1 relating to any one of the first to fifth aspects, the turning portion 24 has a plate-shaped portion 24a that is rotatable around a rotation axis extending in the horizontal direction and is formed into a plate shape that extends downward in the vertical direction.
[0107] In this way, the attitude control device 1 can change the direction of the airflow generated by the thruster 20 simply by changing the rotation angle of the plate-shaped portion 24a. This makes it possible to suppress the rotation and lateral swaying of the suspended load 9 with a simple configuration.
[0108] (7) According to a seventh aspect, in the attitude control device 1 according to any one of the first to fifth aspects, the deflector 24 has a nozzle 24b capable of changing the direction in which the airflow is ejected.
[0109] In this way, the attitude control device 1 can change the direction of the airflow generated by the thruster 20 simply by changing the rotation angle of the nozzle 24b. This makes it possible to suppress the rotation and lateral rolling of the suspended load 9 with a simple configuration.
[0110] (8) According to an eighth aspect, the posture control device 1 for a load 9 of a crane includes a propeller 20 that rotates the blades 22 around a rotation axis 21a extending in the vertical direction to generate an airflow that flows vertically downward, a fixing jig 14 that detachably fixes the propeller 20 to the load 9, a turning unit 24 that turns the airflow generated by the propeller 20, and a control unit 30 that controls the orientation of the turning unit 24. The control unit 30 includes a rotation detection unit 306 that detects whether or not the load 9 is rotating, a rotation control unit 307 that changes the orientation of the turning unit 24 so that the flow direction of the airflow tilts forward in the rotation direction Dr of the load when rotation of the load 9 is detected, a lateral sway detection unit 308 that detects whether or not the load 9 is swaying in the horizontal direction, and a lateral sway control unit 309 that changes the orientation of the turning unit 24 so that the flow direction of the airflow tilts forward in the sway direction Ds of the load 9 when sway of the load 9 is detected.
[0111] (9) According to a ninth aspect, a posture control method is a method for controlling the posture of a load 9 using a posture control device including load holding parts 10, 12 that hold a load 9 of a crane, a propeller 20 that is attached to the load holding parts 10, 12 and rotates a blade 22 around a rotation axis 21a extending in the vertical direction to generate an airflow that flows vertically downward, a turning part 24 that turns the airflow generated by the propeller 20, and a control part 30 that controls the orientation of the turning part 24, the method including the steps of: detecting whether or not the load 9 is rotating by the posture control device 1; if rotation of the load 9 is detected, changing the orientation of the turning part 24 so that the flow direction of the airflow tilts forward in the rotation direction Dr of the load 9; detecting whether or not the load 9 is swaying in the horizontal direction; and if swaying of the load 9 is detected, changing the orientation of the turning part 24 so that the flow direction of the airflow tilts forward in the swaying direction Ds of the load 9.
[0112] (10) According to the tenth aspect, the program causes an attitude control device including load holding parts 10, 12 that hold a load 9 of a crane, a propeller 20 that is attached to the load holding parts 10, 12 and rotates a blade 22 around a rotation axis 21a extending in the vertical direction to generate an airflow that flows vertically downward, a turning part 24 that turns the airflow generated by the propeller 20, and a control part 30 that controls the orientation of the turning part 24 to execute the following steps: a step in which the attitude control device 1 detects whether or not the load 9 is rotating; a step in which, when rotation of the load 9 is detected, the attitude control device 1 changes the orientation of the turning part 24 so that the flow direction of the airflow tilts forward in the rotation direction Dr of the load 9; a step in which the attitude control device 1 detects whether or not the load 9 is swaying in the horizontal direction; and a step in which, when swaying of the load 9 is detected, the attitude control device 1 changes the orientation of the turning part 24 so that the flow direction of the airflow tilts forward in the swaying direction Ds of the load 9. [Explanation of symbols]
[0113] 1 Attitude control device 9 Hanging load 10 Lifting jig (load holding part) 11 holes 12 Container (load holding part) 13 Connection 14 Fixture 20 Propulsion device 21 Electric motor 21a Rotation axis 22 Feather 23 Duct 24 Turning Section 24a Plate-shaped part 24b Nozzle 24c Actuator 25 Manifold 30 Control section 301 Gyro sensor 302 Acceleration Sensor 303 First Auxiliary Sensor 304 Second Auxiliary Sensor 305 Communication Processing Unit 306 Rotation detector 307 Rotation control section 308 Detection Unit 309 Control Unit
Claims
1. A posture control device for a load of a crane, comprising: A load holding portion for holding the load; A propeller attached to the load holding portion and configured to rotate a blade around a rotation axis extending in a vertical direction to generate a vertically downward airflow; A deflection unit that deflects the airflow generated by the propeller; A control unit that controls the orientation of the turning unit; Equipped with The control unit is A rotation detection unit that detects whether or not the suspended load is rotating; A rotation control unit that changes the orientation of the turning unit so that the flow direction of the airflow is tilted forward in the direction of rotation of the suspended load when rotation of the suspended load is detected; A lateral sway detection unit that detects the presence or absence of horizontal sway of the suspended load; a lateral sway control unit that changes the orientation of the turning unit so that the flow direction of the airflow is tilted forward in the sway direction of the suspended load when sway of the suspended load is detected; An attitude control device having
2. The control unit further includes a gyro sensor and a first auxiliary sensor which is a magnetic sensor or a camera. The rotation detection unit calculates an orientation deviation from a target attitude of the load based on a measurement value of the gyro sensor, and corrects the orientation deviation based on a measurement value of the first auxiliary sensor. The attitude control device according to claim 1 .
3. the control unit further includes an acceleration sensor and a second auxiliary sensor which is a positioning sensor, a distance measuring sensor, or a camera; The lateral sway detection unit calculates a position error with respect to a target posture of the suspended load based on a measurement value of the acceleration sensor, and corrects the position error based on a measurement value of the second auxiliary sensor. The attitude control device according to claim 1 .
4. A manifold is further provided that is connected to a lower end of the thruster in a vertical direction and supports the thruster on an upper portion of the load holding portion, The load holding portion is a rectangular member that holds the load by suspending it, and at least one hole is formed vertically on each of the four sides. The manifold divides the airflow generated by the thruster into a plurality of different directions and introduces the airflow into each of the holes, The turning portion is provided at the exit of the hole of the hanging load holding portion. The attitude control device according to claim 1 .
5. the load holding portion is a rectangular member that suspends and holds the load, or a rectangular parallelepiped container that houses and holds the load, At least one of the thrusters is attached to each of the four outer surfaces of the load holding portion, The turning units are provided one below the thruster in the vertical direction, The attitude control device according to claim 1 .
6. The turning portion is rotatable around a rotation axis extending in a horizontal direction and has a plate-shaped portion formed in a plate shape extending downward in a vertical direction. The attitude control device according to claim 1 .
7. The turning portion has a nozzle capable of changing the direction in which the airflow is ejected. The attitude control device according to claim 1 .
8. A posture control device for a load of a crane, comprising: a propeller that rotates blades around a rotation axis extending in a vertical direction to generate a vertically downward air current; A fixing jig that detachably fixes the propeller to the suspended load; A deflection unit that deflects the airflow generated by the propeller; A control unit that controls the orientation of the turning unit; Equipped with The control unit is A rotation detection unit that detects whether or not the suspended load is rotating; A rotation control unit that changes the orientation of the turning unit so that the flow direction of the airflow is tilted forward in the direction of rotation of the suspended load when rotation of the suspended load is detected; A lateral sway detection unit that detects the presence or absence of horizontal sway of the suspended load; a lateral sway control unit that changes the orientation of the turning unit so that the flow direction of the airflow is tilted forward in the sway direction of the suspended load when sway of the suspended load is detected; An attitude control device having
9. A method for controlling the attitude of a load using an attitude control device including a load holding part for holding a load of a crane, a propeller attached to the load holding part and rotating a blade about a rotation axis extending in a vertical direction to generate an air current flowing vertically downward, a deflection part for deflecting the air current generated by the propeller, and a control part for controlling the orientation of the deflection part, A step in which the attitude control device detects whether or not the load is rotating; When rotation of the load is detected, the attitude control device changes the orientation of the turning unit so that the flow direction of the airflow is tilted forward of the rotation direction of the load; A step in which the attitude control device detects whether or not the suspended load is swaying in a horizontal direction; When swaying of the suspended load is detected, the attitude control device changes the orientation of the turning unit so that the flow direction of the airflow is tilted forward in the swaying direction of the suspended load; The attitude control method includes the steps of:
10. A posture control device including a load holding unit that holds a load of a crane, a propeller attached to the load holding unit and that rotates a blade about a rotation axis extending in a vertical direction to generate an air current that flows vertically downward, a deflection unit that deflects the air current generated by the propeller, and a control unit that controls the orientation of the deflection unit, Detecting whether or not the load is rotating; When rotation of the suspended load is detected, changing the orientation of the turning unit so that the flow direction of the airflow is inclined forward of the rotation direction of the suspended load; detecting whether or not the load is swaying in a horizontal direction; When swaying of the suspended load is detected, changing the orientation of the turning unit so that the flow direction of the airflow is inclined forward in the swaying direction of the suspended load; A program that executes the following.
Citation Information
Patent Citations
Attitude control device for suspended cargo
JP2019151470A
Tower crane hung load swinging stop device, positioning device, swinging stop method, and positioning method
JP2022094983A
