Disclosure of Invention
The invention aims to provide a transfer trolley control system and a control method for hoisting a PC (personal computer) component, which have higher flexibility and safety.
The technical scheme of the invention is as follows: a transfer trolley control system for hoisting a PC component is used for controlling the action of a transfer trolley, the transfer trolley comprises a moving chassis, an arm support system, a folding arm and a grabbing tray, the arm support system is hinged between the moving chassis and the folding arm, and a first driving mechanism is connected between the arm support system and the moving chassis; a second driving mechanism is connected between the folding arm and the arm support system; one end of the folding arm, which is far away from the arm support system, is connected with the grabbing tray;
the transfer trolley control system for hoisting the PC component comprises a controller, a first inclination angle sensor and a second inclination angle sensor, wherein the first inclination angle sensor is used for monitoring the pitching angle of the arm support system relative to the horizontal plane, and the second inclination angle sensor is used for monitoring the rotating angle of the folding arm relative to the horizontal plane; the controller is respectively electrically connected with the first inclination angle sensor, the second inclination angle sensor, the first driving mechanism and the second driving mechanism.
Preferably, a third driving mechanism is connected between the grabbing tray and the folding arm; the transfer trolley control system for hoisting the PC component further comprises a third inclination angle sensor for monitoring the rotation angle of the grabbing tray relative to the horizontal plane, the third inclination angle sensor is arranged on the grabbing tray, and the third inclination angle sensor and the third driving mechanism are respectively and electrically connected with the controller.
Preferably, the controller is arranged on the mobile chassis, the first tilt angle sensor is arranged on the arm support system and close to the joint of the arm support system and the folding arm, and the second tilt angle sensor is arranged on the folding arm and close to the joint of the folding arm and the grabbing tray.
Preferably, the boom system comprises a multi-stage telescopic boom and a telescopic oil cylinder for driving the multi-stage telescopic boom to perform telescopic action, the transfer vehicle control system for hoisting the PC component further comprises a length sensor for monitoring the extending length of the multi-stage telescopic boom in the boom system, one end of the length sensor is arranged on the first stage telescopic boom, and the other end of the length sensor is arranged on the last stage telescopic boom; the length sensor and the telescopic oil cylinder are respectively and electrically connected with the controller.
Preferably, the transfer trolley control system for hoisting the PC component further comprises a weighing sensor for monitoring the weight of the PC component grabbed by the grabbing tray, and the weighing sensor is arranged on the grabbing tray.
Preferably, the load cell is located in the middle of the gripping tray.
The invention also provides a control method of the transfer trolley for PC component hoisting, which adopts the control system of the transfer trolley for PC component hoisting to control and comprises the following steps:
step one, unfolding a folding arm:
starting a second driving mechanism to unfold the folding arm and the grabbing tray from the top of the folded transfer trolley to the horizontal position beside the transfer trolley, and monitoring an included angle theta 2 between the folding arm and the horizontal plane in real time through a second inclination angle sensor in the action process of the folding arm;
step two, lifting the arm support system:
starting a first driving mechanism to lift the arm support system, the folding arm and the grabbing tray to a certain height, and when the arm support system, the folding arm and the grabbing tray are lifted, the second driving mechanism is self-adaptive and leveled, so that the folding arm and the grabbing tray are always located at the horizontal position; in the process of lifting the height of the arm support system, the folding arm and the grabbing tray, monitoring an included angle theta 1 between the arm support system and the horizontal plane in real time through a first tilt angle sensor;
step three, grabbing the PC component:
starting the grabbing tray to grab the PC component, moving the transfer trolley to a position where the PC component is preset to be placed, and controlling the position change of the grabbing tray through rotation of the arm support system and the folding arm according to the position where the PC component is preset to be placed;
step four, placing a PC component:
and controlling the grabbing tray to place a PC component to finish one-time hoisting and transferring.
Preferably, the step two and the step three further include a step of rotating the gripping tray:
starting the third driving mechanism, driving the grabbing tray to rotate relative to the folding arm, and enabling the grabbing surface of the grabbing tray to be parallel to the grabbed surface of the PC component; and the included angle between the grabbing tray and the horizontal plane is monitored in real time through a third inclination angle sensor in the rotation process of the grabbing tray.
Preferably, the step three and the step four further include a step of extending the boom system:
the telescopic oil cylinder is started, the multi-stage telescopic arm is driven to extend, the folding arm and the grabbing tray are lifted to a certain height, and the extending length of the multi-stage telescopic arm is monitored in real time through the length sensor.
Preferably, the controller monitors the operation of the transfer vehicle in real time through the formula (1) and starts overload protection:
M1=m1×g×cosθ1(L1+ΔL)/2+m2×g×(cosθ1(L1+ΔL)+L2×cosθ2/2)+(m3+m4)×g×(cosθ1(L1+ΔL)+L2×cosθ2) (1)
wherein m is1Is the total weight of the boom system, L1Is the original length of the boom system, θ1Is the measured value of the first tilt sensor, Δ L is the measured value of the length sensor;
m2is the total weight of the folding arm, L2Length of the folding arms, theta2Is the measured value of the second tilt sensor; m is3Is the total weight of the gripping tray; m is4Is the measured value of the weighing sensor; m1The total tipping moment of the upper part of the transfer trolley;
M0the maximum tilting moment allowed for the transfer trolley;
the controller reads the measured values of the sensors and calculates M according to the formula (1)1A value of and M1And M0Making a comparison when M1Less than M0When the vehicle is in a safe state, the vehicle can be normally used; when M is1Approach to M0And when the safety protection device is used, the controller sends an instruction to the corresponding driving mechanism, so that the driving mechanism only acts within a safety range.
Compared with the related technology, the invention has the beneficial effects that: the control system ensures that the transfer trolley is safer to use, and can effectively avoid accidents such as shaking of the PC component, falling of the PC component or tipping of the transfer trolley and the like; the installation quality and efficiency of the PC component can be improved, and the PC component can be suitable for various different construction sites.
Detailed Description
The present invention will be described in detail below with reference to the embodiments with reference to the attached drawings. It should be noted that the embodiments and features of the embodiments may be combined with each other without conflict. For convenience of description, the words "upper", "lower", "left" and "right" in the following description are used only to indicate the correspondence between the upper, lower, left and right directions of the drawings themselves, and do not limit the structure.
As shown in fig. 1 and fig. 2, the present embodiment provides a transfer trolley control system for PC component hoisting, which is used for controlling the action of a transfer trolley. The transfer trolley comprises a mobile chassis 1, an arm frame system 2, a folding arm 3 and a grabbing tray 4.
The movable chassis 1 can adopt any one of a movable AGV trolley, a self-made movable trolley or an engineering vehicle, can realize modular assembly, and is suitable for different construction sites for hoisting PC components.
The boom system 2 comprises a multi-stage telescopic boom (not numbered) and a telescopic oil cylinder 8 for driving the multi-stage telescopic boom to perform telescopic action. The first-stage telescopic arm of the arm support system 2 is hinged to the mobile chassis 1, pitching of the arm support system 2 relative to the mobile chassis 1 is achieved through the first driving mechanism 5, and a hinged shaft of the first-stage telescopic arm and the mobile chassis 1 is perpendicular to the length direction of the arm support system 2 and parallel to the horizontal plane. In this embodiment, the first driving mechanism 5 is a luffing cylinder. The multi-stage telescopic arms in the arm support system 2 are sequentially sleeved and sequentially extend out when being extended (the extending structure is shown in fig. 4). And the last stage of telescopic arm in the arm support system 2 is hinged with the folding arm 3. The folding arm 3 rotates relative to the arm frame system 2 through the second driving mechanism 6, and a hinge shaft of the last-stage telescopic arm and the folding arm 3 is perpendicular to the length direction of the arm frame system 2 and parallel to the horizontal plane. In this embodiment, the second driving mechanism 6 is a knuckle arm cylinder.
One end of the folding arm 3, which is far away from the arm support system 2, is hinged with the grabbing tray 4. The grabbing tray 4 realizes the rotation of the grabbing tray 4 relative to the folding arm 3 through a third driving mechanism 7, and the hinged shaft of the grabbing tray 4 and the folding arm 3 is vertical to the length direction of the arm frame system 2 and is parallel to the horizontal plane. In this embodiment, the third driving mechanism 7 is a pallet cylinder.
The length direction of the boom system is also the direction of the telescopic motion of each stage of telescopic boom of the boom system.
The transfer trolley control system for PC component hoisting comprises a controller 9, a first inclination angle sensor 10 for monitoring the pitching angle of the arm support system 2 relative to the horizontal plane, a second inclination angle sensor 11 for monitoring the rotating angle of the folding arm 3 relative to the horizontal plane, a third inclination angle sensor 12 for monitoring the rotating angle of the grabbing tray 4 relative to the horizontal plane, a length sensor 13 for monitoring the extending length of the multi-stage telescopic arm in the arm support system 2, and a weighing sensor 14 for monitoring the weight of the PC component grabbed by the grabbing tray 4.
The controller 9 is arranged on the movable chassis and is respectively and electrically connected with the first inclination angle sensor 10, the second inclination angle sensor 11, the third inclination angle sensor 12, the length sensor 13, the weighing sensor 14, the first driving mechanism 5, the second driving mechanism 6, the third driving mechanism 7 and the telescopic oil cylinder 8.
The first tilt angle sensor 10 is arranged on the boom system 2 and close to the connection position of the boom system 2 and the folding arm 3. The second tilt sensor 11 is arranged on the folding arm 3 and close to the connection position of the folding arm 3 and the grabbing tray 4. The third tilt sensor 12 is provided on the gripping tray 4. One end of the length sensor 13 is arranged on the first-stage telescopic arm, and the other end of the length sensor 13 is arranged on the last-stage telescopic arm. The weighing sensor 14 is arranged on the grabbing tray 4 and is positioned in the middle of the grabbing tray 4.
In this embodiment, the length sensor 13 is a pull sensor.
The selected tilt angle sensor is a single-axis tilt angle sensor based on a capacitive 3D-MEMS technology and is used for measuring the horizontal angle change of the system.
The load cell 14 is a device that converts a mass signal into a measurable electrical signal output. All the three sensors are outsourced components.
The invention also provides a control method of the transfer trolley for PC component hoisting, which adopts the control system of the transfer trolley for PC component hoisting to control and comprises the following steps:
step one, unfolding a folding arm:
the controller sends an instruction to the second driving mechanism to start, and drives the folding arm and the grabbing tray to be unfolded from the top of the transfer trolley to the horizontal position beside the transfer trolley; meanwhile, the second tilt angle sensor monitors the included angle theta between the folding arm and the horizontal plane in real time2(as shown in fig. 3), and sends a monitoring signal to the controller, and when the set value is reached, the controller sends a command to the second driving mechanism to stop the action.
Step two, lifting the arm support system:
the controller sends an instruction to the first driving mechanism to start, the arm support system, the folding arm and the grabbing tray are driven to lift to a certain height, and the second driving mechanism is adaptive to level while lifting, so that the folding arm and the grabbing tray are always located at the horizontal position; meanwhile, the first tilt angle sensor monitors the included angle theta between the folding arm and the horizontal plane in real time when the folding arm rotates relative to the arm support system1(as shown in fig. 3) and sends a monitoring signal to the controller, and when a set value is reached, the controller sends a command to the second controllerThe two driving mechanisms stop operating.
Step three, rotating the grabbing tray:
the controller sends an instruction to a third driving mechanism to drive the grabbing tray to rotate relative to the folding arm, so that the grabbing surface of the grabbing tray is parallel to the grabbed surface of the PC component; and meanwhile, a third tilt angle sensor monitors an included angle between the grabbing tray and the horizontal plane when the grabbing tray rotates relative to the folding arm in real time, monitoring signals are sent to the controller, and when a set value is reached, the controller sends an instruction to the third driving mechanism to stop acting.
Step four, grabbing the PC component:
starting the grabbing tray to grab the PC component, moving the transfer trolley to a position where the PC component is preset to be placed, and controlling the position change of the grabbing tray through rotation of the arm support system and the folding arm according to the position where the PC component is preset to be placed;
step five, extending the arm support system (as shown in fig. 4):
the controller sends an instruction to the telescopic oil cylinder to drive the multi-stage telescopic arm to extend, and the folding arm and the grabbing tray are lifted to a certain height; meanwhile, the length sensor monitors the extending length L of the telescopic arm in real time1And + delta L, sending a monitoring signal to the controller, and sending an instruction to the telescopic oil cylinder to stop acting when a set value is reached.
Step six, placing a PC component:
and controlling the grabbing tray to place a PC component to finish one-time hoisting and transferring.
The controller monitors the operation of the transfer trolley in real time through a formula (1) and starts overload protection: m1=m1×g×cosθ1(L1+ΔL)/2+m2×g×(cosθ1(L1+ΔL)+L2×cosθ2/2)+(m3+m4)×g×(cosθ1(L1+ΔL)+L2×cosθ2)(1)
Wherein m is1Is the total weight of the boom system, L1Is the original length of the boom system, θ1Is the measurement value of the first tilt sensor, Δ L is the length transmissionThe measured value of the sensor;
m2is the total weight of the folding arm, L2Length of the folding arms, theta2Is the measured value of the second tilt sensor; m is3Is the total weight of the gripping tray; m is4Is the measured value of the weighing sensor; m1The total tipping moment of the upper part of the transfer trolley; m0The maximum tilting moment allowed for the transfer trolley;
the controller reads the measured values of the sensors and calculates M according to the formula (1)1A value of and M1And M0Making a comparison when M1Less than M0When the vehicle is in a safe state, the vehicle can be normally used; when M is1Approach to M0And when the safety protection device is used, the controller sends an instruction to the corresponding driving mechanism, so that the driving mechanism only acts within a safety range.
As shown in FIG. 3, L2When the folding arm is horizontal, the horizontal distance between two hinged points (namely the length of the folding arm), theta2Is the angle between the nominal 0 point of the tilt sensor and the horizontal plane, L2×cosθ2The projection length of the distance between the two hinged points on the horizontal plane, namely the arm length of the tipping moment, and the tilt angle sensor is calibrated at a point 0 in the state shown in figure 3, so that the projection length of the distance between the two hinged points on the horizontal plane is equal to the length of the folding arm.
As shown in fig. 4, cos θ1(L1And + delta L) is the projection length of the distance between two hinged points of the arm support system on the horizontal plane, namely the arm length of the tipping moment.
As shown in fig. 3 and 4, when the PC component 100 is grabbed, the grabbing tray forms a certain angle with the horizontal plane along with the change of the pitching angle of the boom system, and the controller receives the angle information of the grabbing tray and then controls the third driving mechanism to stretch and retract, so that the grabbing tray always keeps a working angle, and thus, the self-adaptive leveling control of the grabbing tray is realized.
The above description is only an embodiment of the present invention, and not intended to limit the scope of the present invention, and all modifications of equivalent structures and equivalent processes, which are made by using the contents of the present specification and the accompanying drawings, or directly or indirectly applied to other related technical fields, are included in the scope of the present invention.