Truck-mounted suspension arm head trajectory planning method and system

By constructing a three-dimensional Cartesian coordinate system and configuring a terminal control robotic arm, precise trajectory planning of the truck-mounted crane boom head is achieved, solving the problems of high control difficulty and lifting deviation, and improving the speed and safety of lifting operations.

CN118952208AInactive Publication Date: 2024-11-15HUNAN MAMUT HOISTING EQUIPMENT CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411215046.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-30
Publication Date
2024-11-15
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

Existing truck-mounted cranes are difficult to operate in different lifting scenarios. Deviation of the lifting trajectory can easily lead to load damage or safety accidents, and the operation is complicated.

Method used

The method and system for planning the trajectory of a truck-mounted crane boom head are adopted. By constructing a three-dimensional Cartesian coordinate system, configuring position acquisition and drive control terminals, and linking control of the robotic arm, the boom head moves along a preset trajectory.

Benefits of technology

It reduces operational difficulty, improves the speed and safety of hoisting operations, and ensures accurate hoisting of loads in different scenarios.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118952208A_ABST
    Figure CN118952208A_ABST
Patent Text Reader

Abstract

The invention discloses a track planning method and system for a truck-mounted crane arm head. The planning method comprises the steps that the hoisting operation type of a truck-mounted crane is determined; constructing a three-dimensional Cartesian coordinate system; configuring a position acquisition terminal and a driving control terminal for the truck-mounted crane mechanical arm; a joint space with all hinge points of the mechanical arm as the center is constructed, the movement of the mechanical arm is adjusted through the drive control terminal, and the movement of the mechanical arm is established in the joint space; then arm head position data of the mechanical arm is obtained, and real-time transformation is conducted on the joint space based on the arm head position data; and the position data of the arm head are mapped into a three-dimensional Cartesian coordinate system, the motion state of the mechanical arm is determined, and the motion track of the arm head is planned according to different hoisting operation types. According to the technical scheme, compared with the prior art, the mechanical arm can be controlled in a linkage mode when the truck-mounted crane carries out hoisting operation, the arm head is made to move along the preset track, the control difficulty of operators is lowered, and meanwhile the carrying, loading, unloading and transshipping speed is increased.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of vehicle-mounted crane load hoisting, and more specifically, to a vehicle-mounted crane boom head trajectory planning method and system. Background Art

[0002] Truck mounted crane transport vehicle, also known as truck mounted crane, is a transport vehicle that uses a hydraulic lifting and telescopic system to achieve the lifting, rotation and hoisting of goods. It is widely used in the lifting and transportation of infrastructure materials and other equipment in municipal construction, coal mining projects, landscaping, etc.

[0003] At present, the main mechanical structure of the existing truck crane is generally composed of a transport vehicle, a slewing base, a boom, an outer boom, a telescopic arm and a sling. During the use of the truck crane, the operator needs to combine and control the slewing base, the boom, the outer boom, the telescopic arm and other mechanical arms to complete the load lifting operation. However, due to differences in operating scenarios, when the truck crane is loading and unloading, the operator needs to control the arm head to move along an arc, and when reloading, the arm head needs to be controlled to move along a straight line. Different application scenarios require the planning of different lifting trajectories, which is difficult to operate and puts high demands on the ability level of the operators. When less experienced operators start to operate, the hoisted load is very likely to deviate from the normal preset track, and the lifting operation cannot be completed or the load is damaged, and serious safety accidents may occur.

[0004] Therefore, how to provide a method and system for planning the trajectory of a truck-mounted crane boom head, which can control the mechanical arm in a linked manner during the truck-mounted crane lifting operation so that the boom head moves along a preset trajectory, thereby reducing the difficulty of operation for operators and improving the speed of loading, unloading and reloading, has become a technical problem that needs to be urgently solved by technical personnel in this field. Summary of the invention

[0005] In order to solve the above technical problems, the present invention provides a method and system for planning the trajectory of a truck-mounted crane boom head, which can control the mechanical arm in a linked manner when the truck-mounted crane is performing lifting operations, so that the boom head moves along a preset trajectory, thereby reducing the difficulty of operation for operators and improving the speed of loading, unloading and transshipping.

[0006] The technical solution provided by the present invention is as follows:

[0007] The present invention provides a method and system for planning the trajectory of a boom head of a truck-mounted crane, wherein the trajectory planning method comprises: S1, determining the type of operation: determining the type of lifting operation of the truck-mounted crane according to the operation requirements of the truck-mounted crane; S2, establishing a trajectory coordinate system: constructing a three-dimensional Cartesian coordinate system; S3, equipment configuration: configuring a position acquisition terminal and a drive control terminal for the mechanical arm of the truck-mounted crane; S4, building a motion model: constructing a joint space centered on each hinge point of the mechanical arm, adjusting the movement of the mechanical arm by using the drive control terminal, and establishing the movement of the mechanical arm in the joint space; S5, collecting position data: obtaining the position data of the arm head of the mechanical arm by using the position acquisition terminal, and performing real-time transformation of the joint space based on the arm head position data; S6, planning the motion trajectory: mapping the arm head position data to the three-dimensional Cartesian coordinate system, determining the motion state of the mechanical arm at each stage, and planning different arm head motion trajectories according to different lifting operation types.

[0008] Furthermore, in a preferred embodiment of the present invention, in step S1, the types of lifting operations of the truck crane include:

[0009] Unloading operations, unloading the load from the transport vehicle to the ground;

[0010] Loading operations, loading the load from the ground to the transport vehicle;

[0011] Pushing operation: pushing the load from the current transport vehicle to another transport vehicle;

[0012] Pulling operation: pulling the load from another transport vehicle to the current transport vehicle.

[0013] Furthermore, in a preferred embodiment of the present invention, in step S2, the three-dimensional Cartesian coordinate system is constructed as follows:

[0014] Determine that the truck crane is in a horizontal plane, and then set the slewing base of the truck crane as the coordinate origin;

[0015] The direction parallel to the transport vehicle is set as the X-axis, the direction perpendicular to the transport vehicle is set as the Y-axis, the up-down direction is set as the Z-axis, and the direction from the coordinate origin to the rear of the transport vehicle is set as the positive direction of the X-axis;

[0016] Determine the scale and units of measure of the coordinate system based on the specifications of the transport vehicle and load.

[0017] Furthermore, in a preferred embodiment of the present invention, in step S3, the position acquisition terminal adopts a sensor terminal, and the drive control terminal adopts a hydraulic proportional valve.

[0018] Furthermore, in a preferred embodiment of the present invention, in step S6, the planned motion trajectory includes: unloading operation trajectory planning, loading operation trajectory planning, push operation trajectory planning and pull operation trajectory planning.

[0019] Furthermore, in a preferred embodiment of the present invention, the step of unloading operation trajectory planning includes:

[0020] S1. Expand the crane of the truck crane from the folded state to the initial position for unloading operation with one click;

[0021] S2. Then the crane boom moves downward, so that the boom head moves in the positive direction of the X-axis. The outer arm is deployed to ensure that the boom head does not move in the Z-axis direction. The rotation is followed to ensure that the boom head does not move in the Y-axis direction.

[0022] S3, when the arm head reaches the predetermined position in the X-axis direction, the outer arm is unfolded, the arm head moves along an arc, and the rotation follower ensures that the arm head has no displacement in the Y-axis direction;

[0023] S4, after the arm head moves to the predetermined position in an arc, the telescopic arm of the crane is extended to make the arm head move forward along the X-axis direction, the outer arm is deployed to ensure that the arm head has no displacement along the Z-axis direction, and the rotation is followed to ensure that the arm head has no displacement along the Y-axis direction;

[0024] S5. When the arm head reaches the predetermined position, the boom moves downward, and the rotary follower ensures that the arm head has no displacement along the Y-axis direction, so that the load falls to the ground and the unloading is completed.

[0025] Furthermore, in a preferred embodiment of the present invention, the step of planning the loading operation trajectory includes:

[0026] S1, unfolding the crane from a folded state to an initial position for loading operation with one key;

[0027] S2. Move the boom upward to lift the load, and rotate it to ensure that the arm head does not move along the Y-axis direction;

[0028] S3, when the arm head is raised to the predetermined position, the telescopic arm is retracted to make the arm head move in the opposite direction along the X-axis direction, the outer arm is deployed to ensure that the arm head has no displacement along the Z-axis direction, and the rotation is followed to ensure that the arm head has no displacement along the Y-axis direction;

[0029] S4, when the arm head reaches the predetermined position in the X-axis direction, the outer arm is folded back, the arm head moves along an arc, and the rotation follower ensures that the arm head has no displacement in the Y-axis direction;

[0030] S5. Then the boom is lifted to make the arm head move in the opposite direction along the X-axis. The outer arm is unfolded to ensure that the arm head has no displacement along the Z-axis. The rotation is followed to ensure that the arm head has no displacement along the Y-axis. The load is pulled to the predetermined position and the loading is completed.

[0031] Furthermore, in a preferred embodiment of the present invention, the step of planning the push operation trajectory includes:

[0032] S1, unfolding the crane from a folded state to an initial position for a horizontal push operation with one key;

[0033] S2. Move the boom downward to make the arm head move forward along the X-axis direction. The outer arm will follow the movement to ensure that the arm head does not move along the Z-axis direction. The rotation will follow the movement to ensure that the arm head does not move along the Y-axis direction.

[0034] S3. When the boom moves down to the preset position, the telescopic arm begins to extend, and the arm head continues to move forward along the X-axis direction. The boom follows to ensure that the arm head does not move along the Z-axis direction, and the slewing follows to ensure that the arm head does not move along the Y-axis direction.

[0035] S4. Finally, the arm head moves horizontally to the preset position and the horizontal push ends.

[0036] Furthermore, in a preferred embodiment of the present invention, the step of planning the trajectory of the horizontal pulling operation includes:

[0037] S1, unfolding the crane from a folded state to an initial position for horizontal pulling operation with one key;

[0038] S2, retract the telescopic arm, move the arm head in the opposite direction along the X-axis, the boom follow-up ensures that the arm head has no displacement along the Z-axis direction, and the rotation follow-up ensures that the arm head has no displacement along the Y-axis direction;

[0039] S3, when the telescopic arm is retracted to the preset position, the main arm starts to move upward, so that the arm head moves in the opposite direction along the X-axis direction, the outer arm follows to ensure that the arm head has no displacement along the Z-axis direction, and the rotation follows to ensure that the arm head has no displacement along the Y-axis direction;

[0040] S4. Finally, the arm head moves horizontally to the preset position and the horizontal pulling ends.

[0041] The present invention also provides a technical solution:

[0042] The present invention provides a vehicle-mounted boom head trajectory planning system, which is used to implement the vehicle-mounted boom head trajectory planning method, and is characterized in that the vehicle-mounted boom head trajectory planning system comprises: a mechanical arm module, an auxiliary tool module, a hydraulic valve module, a sensor module and an electrical control module;

[0043] The mechanical arm module includes a slewing arm, a main arm, an outer arm and a telescopic arm, which are used to realize the movement of the arm head by rotating the hinge point or extending the length;

[0044] The auxiliary tool module includes a base, an indicator light and an arm hook; the base is arranged on the transport vehicle and is used to connect the transport vehicle body and the truck crane; the indicator light is arranged on the boom and is used to indicate the crane overload protection and component failure signal; the arm hook is arranged at the end of the telescopic arm and is used to connect the hoisting load;

[0045] The hydraulic cylinder module is connected to the mechanical arm module, and the hydraulic rod module includes a mechanical subsystem and an electrical subsystem, which are used to control the valve core opening through CAN bus messages or mechanical handles to adjust the flow and direction of the hydraulic oil and drive the mechanical arm to move in different directions and speeds;

[0046] The sensor module is arranged at the hinge point or the arm head of the robot arm, and is used to obtain the angle and position data of the robot arm, and transmit the data to the electrical control module;

[0047] The electrical control module is communicatively connected with the hydraulic cylinder module and the sensor module. The electrical control module includes a PLC, a remote controller and a control terminal, which are used to control the movement of the mechanical arm, sensor decoding calculation, and monitor the overload protection and system status of the truck crane.

[0048] The present invention provides a method and system for planning the trajectory of a truck crane boom head, wherein the trajectory planning method comprises the following steps: S1, determining the type of operation: determining the type of lifting operation of the truck crane according to the operation requirements of the truck crane; S2, establishing a trajectory coordinate system: constructing a three-dimensional Cartesian coordinate system; S3, equipment configuration: configuring a position acquisition terminal and a drive control terminal for the mechanical arm of the truck crane; S4, building a motion model: constructing a joint space centered on each hinge point of the mechanical arm, adjusting the movement of the mechanical arm using the drive control terminal, and establishing the movement of the mechanical arm in the joint space; S5, collecting position data: obtaining the position data of the arm head of the mechanical arm using the position acquisition terminal, and performing real-time transformation of the joint space based on the arm head position data; S6, planning the motion trajectory: mapping the arm head position data to the three-dimensional Cartesian coordinate system, determining the motion state of the mechanical arm at each stage, and planning different arm head motion trajectories according to different lifting operation types. The described method for planning the trajectory of the boom head of the truck-mounted crane aims at the problem that the boom head of the truck-mounted crane deviates from the preset trajectory during the lifting operation, which may easily cause damage to the load or create a safety hazard. Based on the crane platform of the truck-mounted crane, the position acquisition terminal and the drive control terminal are used to realize precise control of the mechanical arm of the truck-mounted crane. In the described method for planning the trajectory of the boom head of the truck-mounted crane, it is first necessary to determine the type of lifting operation to be performed by the current truck-mounted crane, and then establish a three-dimensional Cartesian coordinate system on the crane platform based on the truck-mounted crane, and use the three-dimensional Cartesian coordinate system to describe the position and speed of the mechanical arm movement, and then set a position acquisition terminal and a drive control terminal for the mechanical arm. The acquisition terminal is used to obtain the position data of the robot arm during its movement, and the drive control terminal is used to drive the robot arm to move along a preset trajectory according to the requirements of the lifting operation. After the equipment configuration is completed, a joint space is established based on the hinge points of the robot arm, and the movement of the robot arm is presented in the joint space. Then, the position data is acquired using the configured terminal, and the movement state of the robot arm in the joint space is converted in real time. Finally, the robot arm movement state data in the joint space is mapped to a three-dimensional Cartesian coordinate system, and the arm head movement trajectory is planned based on the type of lifting operation to achieve precise control of the robot arm movement, so that the robot arm can move along the preset trajectory. It can be seen that the technical solution involved in the present invention, compared with the prior art, can control the robot arm in linkage when the truck crane is performing lifting operations, so that the arm head moves along a preset trajectory, which reduces the difficulty of operation for operators and improves the speed of loading, unloading and reloading. BRIEF DESCRIPTION OF THE DRAWINGS

[0049] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0050] Figure 1 A flowchart of the steps of the vehicle-mounted boom head trajectory planning method provided in an embodiment of the present invention;

[0051] Figure 2 A flowchart of the steps of unloading operation trajectory planning provided by an embodiment of the present invention;

[0052] Figure 3 A flowchart of the steps of loading operation trajectory planning provided by an embodiment of the present invention;

[0053] Figure 4 A flowchart of the steps of the push operation trajectory planning provided by an embodiment of the present invention;

[0054] Figure 5 A flowchart of the steps of the horizontal pulling operation trajectory planning provided by an embodiment of the present invention;

[0055] Figure 6 A schematic diagram of the steps of performing unloading or loading operations of the truck-mounted crane provided in an embodiment of the present invention. DETAILED DESCRIPTION

[0056] In order to enable those skilled in the art to better understand the technical solutions in the present invention, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present invention.

[0057] It should be noted that when an element is referred to as being "fixed on" or "set on" another element, it can be directly on the other element or indirectly set on the other element; when an element is referred to as being "connected to" another element, it can be directly connected to the other element or indirectly connected to the other element.

[0058] It should be understood that the terms "length", "width", "up", "down", "front", "back", "first", "second", "vertical", "horizontal", "top", "bottom", "inside", "outside", etc., indicating the orientation or position relationship are based on the orientation or position relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operate in a specific orientation, and therefore cannot be understood as a limitation on the present invention.

[0059] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include one or more of the features. In the description of the present invention, the meaning of "multiple" and "several" is two or more, unless otherwise clearly and specifically defined.

[0060] It should be noted that the structures, proportions, sizes, etc. illustrated in the drawings of this specification are only used to match the contents disclosed in the specification so as to facilitate understanding and reading by persons familiar with this technology. They are not used to limit the conditions under which the present invention can be implemented, and therefore have no substantive technical significance. Any structural modification, change in proportion or adjustment of size, without affecting the effects and purposes that can be achieved by the present invention, should still fall within the scope of the technical contents disclosed by the present invention.

[0061] like Figures 1 to 6 As shown, the present invention provides a method and system for planning the trajectory of a truck-mounted crane boom head, wherein the method for planning the trajectory of a truck-mounted crane boom head specifically includes the following steps: S1, determining the type of operation: determining the type of lifting operation of the truck-mounted crane according to the operation requirements of the truck-mounted crane; S2, establishing a trajectory coordinate system: constructing a three-dimensional Cartesian coordinate system; S3, equipment configuration: configuring a position acquisition terminal and a drive control terminal for the mechanical arm of the truck-mounted crane; S4, building a motion model: constructing a joint space centered on each hinge point of the mechanical arm, adjusting the movement of the mechanical arm using the drive control terminal, and establishing the movement of the mechanical arm in the joint space; S5, collecting position data: obtaining the position data of the arm head of the mechanical arm using the position acquisition terminal, and performing real-time transformation of the joint space based on the arm head position data; S6, planning the motion trajectory: mapping the arm head position data to the three-dimensional Cartesian coordinate system, determining the motion state of the mechanical arm at each stage, and planning different arm head motion trajectories according to different lifting operation types. The technical solution involved in the present invention can control the mechanical arm in linkage when the truck-mounted crane performs lifting operations, so that the arm head moves along a preset trajectory, thereby reducing the difficulty of operation for operators and improving the speed of loading, unloading and reloading.

[0062] The following is a specific description of the vehicle-mounted boom head trajectory planning method disclosed in the present invention in combination with a specific embodiment. The vehicle-mounted boom head trajectory planning method includes:

[0063] S1. Determine the operation type: Determine the lifting operation type of the truck crane according to the operation requirements of the truck crane.

[0064] Specifically, in a specific embodiment of the present invention, in step S1, the types of lifting operations of the truck crane include: unloading operations, unloading the load from the transport vehicle to the ground; loading operations, loading the load from the ground to the transport vehicle; pushing operations, pushing the load from the current transport vehicle to another transport vehicle; pulling operations, pulling the load from another transport vehicle to the current transport vehicle.

[0065] In an embodiment of the present invention, for the trajectory planning method of the truck-mounted crane boom head, it is first necessary to determine the operation type of the current truck-mounted crane. There are four conventional usage scenarios for truck-mounted cranes, namely, the unloading operation, loading operation, pushing operation and pulling operation; among them, the unloading operation and loading operation are the most commonly used application scenarios. The unloading operation is specifically to use the truck-mounted crane to unload the load loaded on the transport vehicle to the ground or a predetermined position, and the loading operation is specifically to use the truck-mounted crane to install the load placed on the ground on the transport vehicle; secondly, the pushing operation and pulling operation are suitable for the transportation of loads. The pushing operation is specifically to use the truck-mounted crane to push the load of the current transport vehicle to another transport vehicle. The pulling operation is the opposite of the pushing operation, that is, to use the truck-mounted crane to pull the load loaded on another transport vehicle to the transport vehicle of the current truck-mounted crane.

[0066] S2. Establish trajectory coordinate system: construct a three-dimensional Cartesian coordinate system.

[0067] Specifically, in a specific embodiment of the present invention, in step S2, the construction of the three-dimensional Cartesian coordinate system is specifically as follows: determine that the truck crane is in a horizontal plane, and then set the slewing base of the truck crane as the coordinate origin; set the direction parallel to the transport vehicle as the X-axis, the direction perpendicular to the transport vehicle as the Y-axis, the up and down direction as the Z-axis, and the direction pointing horizontally from the coordinate origin to the rear of the transport vehicle as the positive direction of the X-axis; determine the scale and measurement unit of the coordinate system based on the specifications of the transport vehicle and the load.

[0068] In an embodiment of the present invention, after determining the type of lifting operation that the truck crane needs to perform, the next step is to plan the corresponding robot arm motion trajectory for the lifting operation; first, a three-dimensional coordinate system is constructed. In this embodiment, the three-dimensional coordinate system adopts a three-dimensional Cartesian coordinate system, which can clearly describe the position and speed of the robot arm movement; when establishing the three-dimensional Cartesian coordinate system, it is first necessary to level the truck crane to ensure the standard specification of the coordinate system direction, and the coordinate origin is set to the slewing base of the truck crane. Starting from the coordinate origin, the horizontal direction pointing to the rear of the vehicle is the positive direction of the X-axis, the direction perpendicular to the X-axis is set to the Y-axis, and the vertical up and down direction is set to the Z-axis.

[0069] S3. Equipment configuration: configuring a position acquisition terminal and a drive control terminal for the mechanical arm of the truck crane.

[0070] Specifically, in a specific embodiment of the present invention, in step S3, the position acquisition terminal adopts a sensor terminal, and the drive control terminal adopts a hydraulic proportional valve.

[0071] In step S3, a position acquisition terminal and a drive control terminal are configured for the truck crane to achieve precise control of the movement of the robotic arm; in an embodiment of the present invention, the position acquisition terminal adopts a sensor terminal, which is arranged on the hinge point or arm head of the robotic arm, and the sensor terminal includes a position sensor and an angle sensor; the drive control terminal adopts a hydraulic proportional valve, which controls the flow and flow rate of the hydraulic oil, and can control the robotic arm to move along a preset trajectory.

[0072] S4, constructing a motion model: constructing a joint space centered on each hinge point of the robot arm, adjusting the motion of the robot arm using the drive control terminal, and establishing the motion of the robot arm in the joint space.

[0073] S5. Collecting position data: using the position acquisition terminal to obtain the position data of the arm head of the robot arm, and performing real-time transformation of the joint space based on the arm head position data.

[0074] In an embodiment of the present invention, the movement of the robotic arm of the truck crane is established in a joint space centered on each hinge point, and the joint variables of the movement of the robotic arm of the truck crane, such as angle and position, can be converted into a time function to represent the movement posture of the robotic arm at this time, thereby facilitating the planning of the movement trajectory of the robotic arm; and, when the robotic arm moves, the position acquisition terminal obtains the motion parameter data of the arm head of the robotic arm, and according to the motion parameter data, the motion state of the robotic arm can be transformed in real time in the joint space.

[0075] S6. Planning motion trajectory: mapping the arm position data to the three-dimensional Cartesian coordinate system, determining the motion state of the robotic arm at each stage, and planning different arm motion trajectories according to different lifting operation types.

[0076] Specifically, in a specific embodiment of the present invention, in step S6, the planned motion trajectory includes: unloading operation trajectory planning, loading operation trajectory planning, pushing operation trajectory planning and pulling operation trajectory planning.

[0077] In an embodiment of the present invention, since the operation types of the truck crane include unloading operation, loading operation, pushing operation and pulling operation, when performing trajectory planning, it is necessary to plan the motion trajectory of the robot arm separately for each operation type, so the planned motion trajectory includes the unloading operation trajectory planning, loading operation trajectory planning, pushing operation trajectory planning and pulling operation trajectory planning.

[0078] Specifically, in a specific embodiment of the present invention, the steps of unloading operation trajectory planning include: S1, unfolding the crane of the truck crane from a folded state to the initial position of the unloading operation with one button; S2, then moving the crane boom downward to make the arm head move in the positive direction of the X-axis, the outer arm follows the unfolding to ensure that the arm head has no displacement in the Z-axis direction, and the slewing follows to ensure that the arm head has no displacement in the Y-axis direction; S3, when the arm head reaches a predetermined position in the X-axis direction, the outer arm is unfolded, the arm head moves along an arc, and the slewing follows to ensure that the arm head has no displacement in the Y-axis direction;

[0079] S4. After the arm head moves in an arc to the predetermined position, the telescopic arm of the crane is extended to make the arm head move forward along the X-axis direction, and the outer arm is deployed to ensure that the arm head has no displacement along the Z-axis direction, and the rotation follows to ensure that the arm head has no displacement along the Y-axis direction; S5. When the arm head reaches the predetermined position, the boom moves downward, and the rotation follows to ensure that the arm head has no displacement along the Y-axis direction, so that the load falls to the ground and the unloading is completed.

[0080] Among them, Figure 6As shown, in the unloading operation trajectory planning process, the first stage needs to unfold the truck crane to the initial position, which is the lifting position. At this time, the boom head hook of the truck crane is connected to the load; the second stage is the downward movement of the boom, and the load moves along the positive direction of the X-axis on the transport vehicle. Under the drive of the boom, the load moves to the predetermined position. In this stage, to ensure that the load has no displacement in the Y-axis and Z-axis, the outer arm and the slewing base move with the movement of the boom; in the third stage, the outer arm is unfolded, and under the drive of the outer arm, one end of the load connected to the boom head hook is lifted, and the boom head moves along the arc, so that the other end of the load falls to the ground, and the slewing base follows to make the load have no displacement in the Y-axis direction to avoid load swinging; in the fourth stage, the telescopic arm is extended, and under the drive of the telescopic arm, the load continues to move along the positive direction of the X-axis, so that the load completely leaves the transport vehicle; in the fifth stage, when the load moves to the predetermined position in the positive direction of the X-axis, the boom moves down, puts down the lifted end of the load, so that the load is completely placed on the ground, and completes the unloading operation.

[0081] Specifically, in a specific embodiment of the present invention, the steps of loading operation trajectory planning include: S1, unfolding the crane from a folded state to the initial position of the loading operation with one click; S2, moving the boom upward to lift the load, and rotating to ensure that the arm head has no displacement along the Y-axis direction; S3, when the arm head rises to the predetermined position, the telescopic arm retracts to make the arm head move in the opposite direction along the X-axis direction, the outer arm follows to unfold to ensure that the arm head has no displacement in the Z-axis direction, and the rotating follow-up ensures that the arm head has no displacement in the Y-axis direction; S4, when the arm head reaches the predetermined position in the X-axis direction, the outer arm folds back, the arm head moves along an arc, and the rotating follow-up ensures that the arm head has no displacement in the Y-axis direction; S5, then the boom is lifted to make the arm head move in the opposite direction along the X-axis direction, the outer arm follows to unfold to ensure that the arm head has no displacement in the Z-axis direction, and the rotating follow-up ensures that the arm head has no displacement in the Y-axis direction, the load is pulled to the predetermined position, and the loading is completed.

[0082] Among them, Figure 6 As shown, in an embodiment of the present invention, the process of planning the trajectory of the loading operation is opposite to that of the unloading operation. In the loading operation trajectory planning process, in the first stage, the truck crane needs to be unfolded to the initial position of the loading operation. When in the initial position, the load is placed on the ground, and the arm head hook is connected to the load; in the second stage, the boom is moved up, and the end of the load connected to the boom head hook is lifted; in the third stage, the telescopic arm is retracted, and under the drive of the telescopic arm, the load moves in the opposite direction along the X-axis, and when it moves to the predetermined position, the load leans against the rear of the transport vehicle; in the fourth stage, the outer arm is folded back, and the arm head moves along an arc. Under the drive of the outer arm, the load is completely placed on the transport vehicle of the truck crane at this time; in the fifth stage, the boom is lifted, and the load moves in the opposite direction along the X-axis on the transport vehicle. When it moves to the predetermined position, the boom stops moving, and the loading and unloading operations are completed.

[0083] Specifically, in a specific embodiment of the present invention, the steps of trajectory planning for the push operation include: S1, unfolding the crane from a folded state to the initial position of the push operation with one click; S2, moving the boom downward so that the arm head moves in the positive direction along the X-axis direction, the outer arm follows the movement to ensure that the arm head has no displacement in the Z-axis direction, and the rotation follows the movement to ensure that the arm head has no displacement in the Y-axis direction; S3, when the boom moves down to the preset position, the telescopic arm begins to extend, the arm head continues to move in the positive direction along the X-axis direction, the boom follows the movement to ensure that the arm head has no displacement in the Z-axis direction, and the rotation follows the movement to ensure that the arm head has no displacement in the Y-axis direction; S4, finally the arm head moves horizontally to the preset position, and the push operation ends.

[0084] Among them, in an embodiment of the present invention, the trajectory planning process of the push operation can be divided into four stages; in the first stage, the crane is initialized and the crane is in the initial position, at which time the arm head hook of the truck crane is connected to the load; in the second stage, the boom is moved downward, and under the drive of the boom, the load moves in the positive direction of the X-axis during the transportation of the truck crane, and the outer segment arm and the slewing base follow to ensure that the load has no displacement in the Y-axis and Z-axis directions; in the third stage, the boom is moved downward to a preset position, at which time the load is also moved to a predetermined position on the transport vehicle, and then the telescopic arm is extended to move the load toward another truck crane; in the fourth stage, when the load is placed on another transport vehicle, the load continues to move under the drive of the telescopic arm, and when it moves to the predetermined position of another transport vehicle, the push operation is completed.

[0085] Specifically, in a specific embodiment of the present invention, the steps of trajectory planning for the horizontal pulling operation include: S1, unfolding the crane from a folded state to the initial position of the horizontal pulling operation with one click; S2, retracting the telescopic arm, and moving the arm head in the opposite direction along the X-axis direction. The boom follows to ensure that the arm head has no displacement in the Z-axis direction, and the rotation follows to ensure that the arm head has no displacement in the Y-axis direction; S3, when the telescopic arm is retracted to the preset position, the boom starts to move up, so that the arm head moves in the opposite direction along the X-axis direction, the outer arm follows to unfold to ensure that the arm head has no displacement in the Z-axis direction, and the rotation follows to ensure that the arm head has no displacement in the Y-axis direction; S4, finally the arm head is translated to the preset position, and the horizontal pulling ends.

[0086] Among them, in an embodiment of the present invention, the process of trajectory planning for the horizontal pulling operation is exactly opposite to that of trajectory planning for the horizontal pushing operation, and the process of trajectory planning for the horizontal pulling operation can also be divided into four stages; in the first stage, the crane is initialized, at which time the crane arm head hook is connected to the load placed on another transport vehicle; in the second stage, the telescopic arm is retracted, and the load moves in the opposite direction along the X-axis, so that the load gradually approaches the transport vehicle that currently needs to be loaded, and when the load moves to the current transport vehicle, it reaches a predetermined position; in the third stage, the boom is moved up, and the load continues to move in the opposite direction along the X-axis on the current transport vehicle under the drive of the boom; in the fourth stage, when the boom moves up to the preset position, that is, when the load moves to the predetermined position on the transport vehicle, the horizontal pulling ends, and the horizontal pulling operation is completed.

[0087] In addition, an embodiment of the present invention further provides a vehicle-mounted boom head trajectory planning system, the vehicle-mounted boom head trajectory planning system is used to implement the vehicle-mounted boom head trajectory planning method, the system includes: a mechanical arm module, an auxiliary tool module, a hydraulic valve module, a sensor module and an electrical control module; the mechanical arm module includes a slewing arm, a large arm, an outer arm and a telescopic arm, which are used to realize the movement of the arm head by rotating the hinge point or extending the length; the auxiliary tool module includes a base, an indicator light and an arm head hook; the base is arranged on the transport vehicle, and is used to connect the transport vehicle body and the vehicle-mounted crane; the indicator light is arranged on the large arm, and is used to indicate the crane overload protection and component failure signal; the arm head hook is arranged at the end of the telescopic arm, and is used to connect the ... connect the vehicle body and the vehicle-mounted crane; the indicator light is arranged on the large arm, and is used to connect the vehicle body and the vehicle-mounted crane; the indicator light is arranged on the large arm, and is used to connect The hydraulic cylinder module is connected to the mechanical arm module, and the hydraulic rod module includes a mechanical subsystem and an electrical subsystem, which are used to control the valve core opening through CAN bus messages or mechanical handles to adjust the flow and direction of the hydraulic oil and drive the mechanical arm to move in different directions and speeds; the sensor module is arranged on the mechanical arm hinge point or arm head, and is used to obtain the angle and position data of the mechanical arm, and transmit the data to the electrical control module; the electrical control module is communicatively connected with the hydraulic cylinder module and the sensor module, and the electrical control module includes a PLC, a remote controller and a control terminal, which are used to control the movement of the mechanical arm, the sensor decoding calculation, and monitor the overload protection and system status of the truck crane.

[0088] To be more specific, an embodiment of the present invention relates to a method and system for planning the trajectory of a truck-mounted crane boom head. The method for planning the trajectory of a truck-mounted crane boom head aims to solve the problem that the boom head of the truck-mounted crane deviates from a preset trajectory during a lifting operation, which may easily cause damage to the load or create a safety hazard. Based on the crane platform of the truck-mounted crane, high-precision position, angle or length sensors and hydraulic control valves are used to achieve precise control of the mechanical arm of the truck-mounted crane. In the method for planning the trajectory of the truck-mounted crane boom head, it is first necessary to determine the type of lifting operation that the current truck-mounted crane needs to perform among the four types of operations: unloading operation, loading operation, horizontal pushing operation and horizontal pulling operation. Then, a three-dimensional Cartesian coordinate system is established based on the crane platform of the truck-mounted crane. The three-dimensional Cartesian coordinate system is used to describe the position and speed of the mechanical arm movement. Then, a position acquisition terminal is set for the mechanical arm. and a drive control terminal, the position acquisition terminal is used to obtain the position data of the mechanical arm when it moves, and the drive control terminal is used to drive the mechanical arm to install a predetermined trajectory according to the requirements of the lifting operation. After the equipment configuration is completed, a joint space is established based on the hinge points of the mechanical arm as the center, and the movement of the mechanical arm is presented in the joint space. The joint vector of the movement of the mechanical arm of the truck crane is converted into a time function, which can more clearly show the movement posture and movement state of the mechanical arm. Then, the position data is acquired by using the configured terminal, and the movement state of the mechanical arm in the joint space is converted in real time. Finally, the movement state data of the mechanical arm in the joint space is mapped to a three-dimensional Cartesian coordinate system, and the arm head movement trajectory is planned based on different lifting operation types. The mechanical arm movement is accurately controlled so that the mechanical arm can move according to the preset trajectory. It can be seen that the technical solution involved in the present invention, compared with the prior art, can control the mechanical arm in linkage when the truck crane performs lifting operations, so that the arm head moves along the preset trajectory, reducing the difficulty of operation for operators while improving the speed of loading, unloading and reloading.

[0089] The above description of the disclosed embodiments enables those skilled in the art to implement or use the present invention. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A method for trajectory planning of a vehicle-mounted boom head. It is characterized in that The following steps are involved: S1. Determine the operation type: Determine the lifting operation type of the truck crane according to the operation requirements of the truck crane; S2. Establish trajectory coordinate system: construct a three-dimensional Cartesian coordinate system; S3, equipment configuration: configuring a position acquisition terminal and a drive control terminal for the mechanical arm of the truck crane; S4, constructing a motion model: constructing a joint space centered on each hinge point of the robot arm, adjusting the motion of the robot arm using the drive control terminal, and establishing the motion of the robot arm in the joint space; S5, collecting position data: using the position collection terminal to obtain the position data of the arm head of the robot arm, and performing real-time transformation of the joint space based on the arm head position data; S6. Planning the motion trajectory: mapping the arm position data to a three-dimensional Cartesian coordinate system, determining the motion state of the robotic arm at each stage, and planning the arm motion trajectory according to different lifting operation types.

2. The vehicle-mounted boom head trajectory planning method according to claim 1, It is characterized in that In step S1, the types of lifting operations of the truck crane include: Unloading operations, unloading the load from the transport vehicle to the ground; Loading operations, loading the load from the ground to the transport vehicle; Pushing operation: pushing the load from the current transport vehicle to another transport vehicle; Pulling operation: pulling the load from another transport vehicle to the current transport vehicle.

3. The vehicle-mounted boom head trajectory planning method according to claim 2, It is characterized in that In step S2, the three-dimensional Cartesian coordinate system is constructed as follows: Determine that the truck crane is in a horizontal plane, and set the slewing base of the truck crane as the coordinate origin; The direction parallel to the transport vehicle is set as the X-axis, the direction perpendicular to the transport vehicle is set as the Y-axis, the up-down direction is set as the Z-axis, and the direction from the coordinate origin to the rear of the transport vehicle is set as the positive direction of the X-axis; The scale and units of measure of the coordinate system are determined based on the specifications of the transport vehicle and the load.

4. The vehicle-mounted boom head trajectory planning method according to claim 1, It is characterized in that In step S3, the position acquisition terminal adopts a sensor terminal, and the drive control terminal adopts a hydraulic proportional valve.

5. The vehicle-mounted boom head trajectory planning method according to claim 3, It is characterized in that In step S6, the planned motion trajectory includes: unloading operation trajectory planning, loading operation trajectory planning, push operation trajectory planning and pull operation trajectory planning.

6. The method for trajectory planning of a vehicle-mounted boom head according to claim 5, It is characterized in that The steps of unloading operation trajectory planning include: S1. Expand the crane of the truck crane from the folded state to the initial position for unloading operation with one click; S2. Then the crane boom moves downward, so that the boom head moves in the positive direction of the X-axis. The outer arm is deployed to ensure that the boom head does not move in the Z-axis direction. The rotation is followed to ensure that the boom head does not move in the Y-axis direction. S3, when the arm head reaches the predetermined position in the X-axis direction, the outer arm is unfolded, the arm head moves along an arc, and the rotation follower ensures that the arm head has no displacement in the Y-axis direction; S4, after the arm head moves to the predetermined position in an arc, the telescopic arm of the crane is extended to make the arm head move forward along the X-axis direction, the outer arm is deployed to ensure that the arm head has no displacement along the Z-axis direction, and the rotation is followed to ensure that the arm head has no displacement along the Y-axis direction; S5. When the arm head reaches the predetermined position, the boom moves downward, and the rotary follower ensures that the arm head has no displacement along the Y-axis direction, so that the load falls to the ground and the unloading is completed.

7. The vehicle-mounted boom head trajectory planning method according to claim 5, It is characterized in that The steps of loading operation trajectory planning include: S1, unfolding the crane from a folded state to an initial position for loading operation with one key; S2. Move the boom upward to lift the load, and rotate it to ensure that the arm head does not move along the Y-axis direction; S3, when the arm head is raised to the predetermined position, the telescopic arm is retracted to make the arm head move in the opposite direction along the X-axis direction, the outer arm is deployed to ensure that the arm head has no displacement along the Z-axis direction, and the rotation is followed to ensure that the arm head has no displacement along the Y-axis direction; S4, when the arm head reaches the predetermined position in the X-axis direction, the outer arm is folded back, the arm head moves along an arc, and the rotation follower ensures that the arm head has no displacement in the Y-axis direction; S5. The boom is lifted to make the arm head move in the opposite direction along the X-axis. The outer arm is unfolded to ensure that the arm head has no displacement along the Z-axis. The rotation is followed to ensure that the arm head has no displacement along the Y-axis. The load is pulled to the predetermined position and the loading is completed.

8. The vehicle-mounted boom head trajectory planning method according to claim 5, It is characterized in that The step of horizontal push operation trajectory planning includes: S1, unfolding the crane from a folded state to an initial position for a horizontal push operation with one key; S2. Move the boom downward to make the arm head move forward along the X-axis direction. The outer arm will follow the movement to ensure that the arm head does not move along the Z-axis direction. The rotation will follow the movement to ensure that the arm head does not move along the Y-axis direction. S3. When the boom moves down to the preset position, the telescopic arm begins to extend, and the arm head continues to move forward along the X-axis direction. The boom follows to ensure that the arm head does not move along the Z-axis direction, and the slewing follows to ensure that the arm head does not move along the Y-axis direction. S4: The arm head moves horizontally to the preset position and the horizontal push ends.

9. The vehicle-mounted boom head trajectory planning method according to claim 5, It is characterized in that The steps of horizontal pulling operation trajectory planning include: S1, unfolding the crane from a folded state to an initial position for horizontal pulling operation with one key; S2, retract the telescopic arm, move the arm head in the opposite direction along the X-axis, the boom follow-up ensures that the arm head has no displacement along the Z-axis direction, and the rotation follow-up ensures that the arm head has no displacement along the Y-axis direction; S3, when the telescopic arm is retracted to the preset position, the boom starts to move upward, so that the arm head moves in the opposite direction along the X-axis direction, the outer arm follows to expand to ensure that the arm head has no displacement along the Z-axis direction, and the rotation follows to ensure that the arm head has no displacement along the Y-axis direction; S4. The arm head moves horizontally to the preset position and the horizontal pulling ends.

10. A vehicle-mounted boom head trajectory planning system, used to implement the vehicle-mounted boom head trajectory planning method as claimed in claims 1 to 9, It is characterized in that include: Robotic arm module, auxiliary tool module, hydraulic valve module, sensor module and electrical control module; The mechanical arm module includes a slewing arm, a main arm, an outer arm and a telescopic arm, which are used to realize the movement of the arm head by rotating the hinge point or extending the length; The auxiliary tool module includes a base, an indicator light and an arm hook; the base is arranged on the transport vehicle and is used to connect the transport vehicle body and the truck crane; the indicator light is arranged on the boom and is used to indicate the crane overload protection and component failure signal; the arm hook is arranged at the end of the telescopic arm and is used to connect the hoisting load; The hydraulic cylinder module is connected to the mechanical arm module, and the hydraulic rod module includes a mechanical subsystem and an electrical subsystem, which are used to control the valve core opening through CAN bus messages or mechanical handles to adjust the flow and direction of the hydraulic oil and drive the mechanical arm to move in different directions and speeds; The sensor module is arranged at the hinge point or the arm head of the robot arm, and is used to obtain the angle and position data of the robot arm, and transmit the data to the electrical control module; The electrical control module is communicatively connected with the hydraulic cylinder module and the sensor module. The electrical control module includes a PLC, a remote controller and a control terminal, which are used to control the movement of the mechanical arm, sensor decoding calculation, and monitor the overload protection and system status of the truck crane.