Telescopic fork device for hoisting container and control method
Technical Field
The invention relates to the technical field of mechanical automation control, in particular to a telescopic fork device for lifting a container and a control method.
Background
At present, the logistics industry relates to the carrying of containers, or the heavy truck automatically exchanges electricity, to the carrying of rule box, because the case weight, the carrying butt joint requires highly to the location, and the manual work adopts fork truck can not accomplish smoothly, must adopt the robot to accomplish.
Disclosure of Invention
The invention provides a telescopic fork device for hoisting a container and a control method thereof aiming at the requirements.
The invention adopts the following technical scheme:
the invention relates to a telescopic fork device for hoisting a container, which comprises two rails and a trolley moving back and forth on the rails, wherein an up-down lifting platform is arranged on the trolley, and a telescopic fork is hoisted in the left-right direction below the lifting platform; the method is characterized in that: a front-back direction displacement sensor is arranged on the mobile trolley; four distance measuring sensors are symmetrically arranged on two sides of the trolley respectively; the up-down lifting platform is provided with a displacement sensor for measuring the height of the platform; a displacement sensor is arranged on the telescopic fork to measure the position of the telescopic fork; hoisting a lifting appliance below the telescopic fork; installing downward ranging sensors at the left and right positions of the lifting appliance; a descending in-place induction sensor is arranged in the middle of the lifting appliance;
the moving trolley is provided with a front-back direction displacement sensor which is a rack, a gear matched with the rack and an absolute value rotary encoder coaxial with the gear; the up-down lifting platform is provided with a displacement sensor which is a screw rod and an absolute value rotary encoder coaxially connected with the screw rod; the telescopic fork is provided with a displacement sensor which is an absolute value rotary encoder coaxially connected with the motor.
The left side and the right side of the trolley are respectively provided with four distance measuring sensors which are arranged in a bilateral symmetry mode, the center distance of the two middle sensors is smaller than the difference value between the front depth and the back depth of the container and the distance between the containers, and the center distance of the two outer sensors is slightly larger than the front depth and the back depth of the container.
The lifting hook below the lifting appliance can rotate outwards, the lifting hook is provided with a falling-in-place induction sensor at the same horizontal position, and the center distance of downward distance measuring sensors arranged at the left side and the right side of the lifting appliance is slightly larger than the left width and the right width of the container.
The control method comprises the following steps:
firstly, a plurality of containers which are not used are sequentially and regularly arranged on one side of a track at the same interval, the original point position of a trolley is on the same straight line with the central line of the middle container of the containers, a vacant position is reserved, a control system samples the data of four distance measuring sensors on the side, the sum of the average value of two distance measuring values in the middle and the sum of the center distance of the distance measuring sensors on the two sides of the trolley and the left and right width of the containers is the y-axis coordinate of the containers (the right side is positive, the left side is negative), and the data of the two distance measuring sensors on the outer side are sampled and both the data of the two distance measuring sensors are beyond the measuring range;
secondly, the truck-mounted used container is stopped at the other side of the track, and the center of the truck-mounted used container and the origin of the trolley are approximately on the same straight line;
thirdly, the control system samples data of four distance measuring sensors at the truck side, the data of the two distance measuring sensors in the middle are smaller than a first set value (such as 400mm), then the difference value of the distance measuring values of the two distance measuring sensors in the middle of the four distance measuring sensors at the side is compared, if the difference value is smaller than a second set value, the truck is shown to be at the correct position, the sum of the average value of the two distance measuring values and the sum of the center distance of the distance measuring sensors at the two sides of the truck and the half of the left-right width of a container is the y-axis coordinate of the container on the truck (the right side is positive, the left side is negative), and the next operation can be carried out;
step four, if any one of the two middle distance measuring values is larger than a first set value or the difference value of the two middle distance measuring values is larger than or equal to a second set value in the step three, the fact that the truck is incorrectly parked and needs to be parked again is indicated, and then the step two is carried out;
step five, the control system samples two outer distance measurement values, if the sampling values are both larger than a first set value, the x-axis coordinate of the truck is 0;
step six, if one of the sampling values is smaller than a first set value in the step five, the trolley moves slowly to the direction of the distance measuring sensor larger than the first set value until two distance measuring values on the outer side are both larger than the first set value, the displacement value of the x axis is the x axis coordinate of the truck cargo box, the forward moving coordinate of the trolley is positive, and the backward moving coordinate of the trolley is negative;
step seven, the telescopic fork rapidly extends a certain distance (the difference value of the y-axis coordinate of the container minus the set slow-speed distance) to the side direction of the truck, the slow-speed extension is changed to set the slow-speed distance, the value of a ranging sensor in the front of the extension direction below the lifting appliance is read as the z-axis coordinate of the container, and the downward direction is positive;
step eight, the control system compares whether the ranging values of the downward ranging sensors on the two sides of the lifting appliance are both larger than a third set value, if not, the lifting appliance is stopped to alarm, and manual processing is switched;
step nine, the lifting appliance descends quickly by the distance of the difference value of the z-axis coordinate minus the slow descending distance, and then descends slowly by a certain distance until the lifting appliance is lowered to the position for sensing;
step ten, the lifting appliance rotates outwards by 90 degrees and just rotates to the lower part of the front beam and the rear beam of the container;
step eleven, slowly lifting the lifting appliance to the original point position of the z axis;
step twelve, the telescopic fork is retracted to the middle position and the y-axis origin position;
step thirteen, the device slowly moves to the x-axis coordinate of the empty position at the side of the unused cargo box along the x-axis direction, if the x-axis coordinate of the current position is smaller than the x-axis coordinate of the target position, the device moves forwards, otherwise, the device moves backwards, the moving distance is the absolute value of the difference value of the x-axis coordinates of the two positions, and the device stops after reaching the displacement;
step fourteen, the control system samples whether the four distance measuring sensors on the side of the cargo container which are not used by the trolley do not have distance measuring values or are larger than a fourth set value, if not, the trolley is shut down to give an alarm, and manual processing is switched;
fifteen, slowly descending the lifting appliance for a certain distance until the lifting appliance is lowered to a position for sensing;
sixthly, rotating the lifting appliance inwards by 90 degrees to enable the lifting hook to be separated from the beam of the container;
seventhly, slowly raising the lifting appliance for a certain distance, and rapidly raising the lifting appliance to the original point of the z axis to stop;
eighteen, retracting the telescopic fork to the middle position and the y-axis original point position;
nineteen, moving the device to an x-axis coordinate position of an unused container to be taken along the x-axis direction;
twenty, if the x-axis coordinate of the current position is smaller than the x-axis coordinate of the target position, the device moves forwards, otherwise, the device moves backwards, the moving distance is the absolute value of the difference value of the x-axis coordinates of the two positions, and the device stops when the position is reached;
twenty one, controlling a system to sample whether the two distance measuring sensors on the outer side of the cargo box, which is not used by the trolley, have no distance measuring value or are greater than a fourth set value, if not, stopping the trolley for alarming, and turning to manual processing;
twenty-two, the distance of the difference value of the slow-speed distance subtracted from the absolute value of the y-axis coordinate of the container rapidly extending out of the telescopic fork to the truck side is changed into the slow-speed extending-out distance, and the values of the ranging sensors on the two sides of the lifting appliance are read, and are both larger than the fifth set value? If not, alarming and stopping the machine, and turning to manual processing;
twenty-third, the lifting appliance descends quickly by the distance of subtracting the slow descending distance difference from the z-axis coordinate, and then descends slowly by a certain distance until the lifting appliance is positioned;
twenty-four steps, the lifting appliance rotates outwards by 90 degrees and just rotates to the lower part of the front beam and the rear beam of the container;
twenty-five, slowly lifting the lifting appliance to the original point position of the z axis;
twenty-six, retracting the telescopic fork to the middle position and the y-axis origin position;
twenty-seventh, the device moves to the x-axis coordinate of the truck at a slow speed along the x-axis direction, if the x-axis coordinate of the current position is smaller than the x-axis coordinate of the target position, the device moves forwards, otherwise, the device moves backwards, the moving distance is the absolute value of the difference value of the x-axis coordinates of the two positions, and the device stops when the position is reached;
twenty-eight steps, are four distance measuring sensors on the truck side of the device all greater than the fourth setting value? Otherwise, alarming and stopping the machine, and turning to manual processing;
twenty-nine, slowly lowering the lifting appliance for a certain distance until the lifting appliance is lowered to a position to be sensed, wherein the Z-axis coordinate of the truck container is less than or equal to that of the truck container;
thirty, rotating the lifting appliance inwards by 90 degrees to enable the lifting hook to be separated from the beam of the container;
thirty-one, slowly lifting the lifting appliance for a certain distance, and quickly lifting the lifting appliance to the original point position of the z axis to stop;
step thirty-two, the telescopic fork is retracted to the middle position and the origin of the y axis; the action is ended.
Advantageous effects
The invention provides a telescopic fork device for hoisting a container, which is used for realizing quick and automatic replacement of a battery box in the logistics transportation industry, particularly in the field of replacement of new energy heavy trucks.
Drawings
The features and advantages of the present invention will be more clearly understood by reference to the accompanying drawings, which are illustrative and not to be construed as limiting the invention in any way, and in which:
FIG. 1 is a schematic view of a system for using the present invention;
FIG. 2 is a schematic structural view of the present invention;
FIG. 3 is a schematic view of the control system of the present invention;
FIG. 4 is a block diagram of an embodiment of the present invention;
in the figure, a is a cargo box or a battery box on a truck; b is the device of the invention; c is an unused container placement area; d is a vacant location for unused cargo areas; 1 is a track; 2 is an x-axis driving system; 3 is an x-axis displacement sensor; 41. 42, 43 and 44 are four distance measuring sensors arranged at the lower position of the left side of the device; 45. 46, 47 and 48 are four distance measuring sensors which are symmetrically arranged at the lower part of the right side of the device; 5 is a lifting platform; 6 is a telescopic fork; 7 is a telescopic fork driving and displacement measuring system; 8 is a lifting appliance; 91. 92, a distance measuring sensor for the left side and the right side of the lifting appliance downwards; 10 is a lifting driving mechanism; 11 is a platform lifting displacement sensor; 12 is a lifting hook; 13 is a hook in-position induction sensor; 14 is a cargo box.
Detailed Description
In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are some, but not all, embodiments of the present invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
Example one
As shown in fig. 1 and 2: the invention relates to a telescopic fork device for hoisting a container, which comprises two rails and a trolley moving back and forth on the rails, wherein an up-down lifting platform is arranged on the trolley, and a telescopic fork is hoisted in the left-right direction below the lifting platform; the method is characterized in that: a front-back direction displacement sensor is arranged on the mobile trolley; four distance measuring sensors are symmetrically arranged on two sides of the trolley respectively; the up-down lifting platform is provided with a displacement sensor for measuring the height of the platform; a displacement sensor is arranged on the telescopic fork to measure the position of the telescopic fork; hoisting a lifting appliance below the telescopic fork; installing downward ranging sensors at the left and right positions of the lifting appliance; a descending in-place induction sensor is arranged in the middle of the lifting appliance;
the moving trolley is provided with a front-back direction displacement sensor which is a rack, a gear matched with the rack and an absolute value rotary encoder coaxial with the gear; the up-down lifting platform is provided with a displacement sensor which is a screw rod and an absolute value rotary encoder coaxially connected with the screw rod; the telescopic fork is provided with a displacement sensor which is an absolute value rotary encoder coaxially connected with the motor.
The left side and the right side of the trolley are respectively provided with four distance measuring sensors which are arranged in a bilateral symmetry mode, the center distance of the two middle sensors is smaller than the difference value between the front depth and the back depth of the container and the distance between the containers, and the center distance of the two outer sensors is slightly larger than the front depth and the back depth of the container.
The lifting hook below the lifting appliance can rotate outwards, the lifting hook is provided with a falling-in-place induction sensor at the same horizontal position, and the center distance of downward distance measuring sensors arranged at the left side and the right side of the lifting appliance is slightly larger than the left width and the right width of the container.
As shown in fig. 3 and 4: the invention discloses a control method of a telescopic fork device for lifting a container, which comprises the following steps:
firstly, a plurality of containers which are not used are sequentially and regularly arranged on one side of a track at the same interval, the original point position of a trolley is on the same straight line with the central line of the middle container of the containers, a vacant position is reserved, a control system samples the data of four distance measuring sensors on the side, the sum of the average value of two distance measuring values in the middle and the sum of the center distance of the distance measuring sensors on the two sides of the trolley and the left and right width of the containers is the y-axis coordinate of the containers (the right side is positive, the left side is negative), and the data of the two distance measuring sensors on the outer side are sampled and both the data of the two distance measuring sensors are beyond the measuring range;
secondly, the truck-mounted used container is stopped at the other side of the track, and the center of the truck-mounted used container and the origin of the trolley are approximately on the same straight line;
thirdly, the control system samples data of four distance measuring sensors at the truck side, the data of the two distance measuring sensors in the middle are smaller than a first set value (such as 400mm), then the difference value of the distance measuring values of the two distance measuring sensors in the middle of the four distance measuring sensors at the side is compared, if the difference value is smaller than a second set value, the truck is shown to be at the correct position, the sum of the average value of the two distance measuring values and the sum of the center distance of the distance measuring sensors at the two sides of the truck and the half of the left-right width of a container is the y-axis coordinate of the container on the truck (the right side is positive, the left side is negative), and the next operation can be carried out;
step four, if any one of the two middle distance measuring values is larger than a first set value or the difference value of the two middle distance measuring values is larger than or equal to a second set value in the step three, the fact that the truck is incorrectly parked and needs to be parked again is indicated, and then the step two is carried out;
step five, the control system samples two outer distance measurement values, if the sampling values are both larger than a first set value, the x-axis coordinate of the truck is 0;
step six, if one of the sampling values is smaller than a first set value in the step five, the trolley moves slowly to the direction of the distance measuring sensor larger than the first set value until two distance measuring values on the outer side are both larger than the first set value, the displacement value of the x axis is the x axis coordinate of the truck cargo box, the forward moving coordinate of the trolley is positive, and the backward moving coordinate of the trolley is negative;
step seven, the telescopic fork rapidly extends a certain distance (the difference value of the y-axis coordinate of the container minus the set slow-speed distance) to the side direction of the truck, the slow-speed extension is changed to set the slow-speed distance, the value of a ranging sensor in the front of the extension direction below the lifting appliance is read as the z-axis coordinate of the container, and the downward direction is positive;
step eight, the control system compares whether the ranging values of the downward ranging sensors on the two sides of the lifting appliance are both larger than a third set value, if not, the lifting appliance is stopped to alarm, and manual processing is switched;
step nine, the lifting appliance descends quickly by the distance of the difference value of the z-axis coordinate minus the slow descending distance, and then descends slowly by a certain distance until the lifting appliance is lowered to the position for sensing;
step ten, the lifting appliance rotates outwards by 90 degrees and just rotates to the lower part of the front beam and the rear beam of the container;
step eleven, slowly lifting the lifting appliance to the original point position of the z axis;
step twelve, the telescopic fork is retracted to the middle position and the y-axis origin position;
step thirteen, the device slowly moves to the x-axis coordinate of the empty position at the side of the unused cargo box along the x-axis direction, if the x-axis coordinate of the current position is smaller than the x-axis coordinate of the target position, the device moves forwards, otherwise, the device moves backwards, the moving distance is the absolute value of the difference value of the x-axis coordinates of the two positions, and the device stops after reaching the displacement;
fourteen, does the control system sample whether the four distance measuring sensors on the side of the cargo container are not used by the trolley and have no distance measuring value (or are larger than a fourth set value) or not? If not, stopping the machine to alarm, and turning to manual processing;
fifteen, slowly descending the lifting appliance for a certain distance until the lifting appliance is lowered to a position for sensing;
sixthly, rotating the lifting appliance inwards by 90 degrees to enable the lifting hook to be separated from the beam of the container;
seventhly, slowly raising the lifting appliance for a certain distance, and rapidly raising the lifting appliance to the original point of the z axis to stop;
eighteen, retracting the telescopic fork to the middle position and the y-axis original point position;
nineteen, moving the device to an x-axis coordinate position of an unused container to be taken along the x-axis direction;
twenty, if the x-axis coordinate of the current position is smaller than the x-axis coordinate of the target position, the device moves forwards, otherwise, the device moves backwards, the moving distance is the absolute value of the difference value of the x-axis coordinates of the two positions, and the device stops when the position is reached;
twenty one, does the control system sample whether the two distance measuring sensors on the outer side of the container side of the trolley are not used and have no distance measuring value (or are greater than the fourth set value)? If not, stopping the machine to alarm, and turning to manual processing;
twenty-two, the distance of the difference value of the slow-speed distance subtracted from the absolute value of the y-axis coordinate of the container rapidly extending out of the telescopic fork to the truck side is changed into the slow-speed extending-out distance, and the values of the ranging sensors on the two sides of the lifting appliance are read, and are both larger than the fifth set value? If not, alarming and stopping the machine, and turning to manual processing;
twenty-third, the lifting appliance descends quickly by the distance of subtracting the slow descending distance difference from the z-axis coordinate, and then descends slowly by a certain distance until the lifting appliance is positioned;
twenty-four steps, the lifting appliance rotates outwards by 90 degrees and just rotates to the lower part of the front beam and the rear beam of the container;
twenty-five, slowly lifting the lifting appliance to the original point position of the z axis;
twenty-six, retracting the telescopic fork to the middle position and the y-axis origin position;
twenty-seventh, the device moves to the x-axis coordinate of the truck at a slow speed along the x-axis direction, if the x-axis coordinate of the current position is smaller than the x-axis coordinate of the target position, the device moves forwards, otherwise, the device moves backwards, the moving distance is the absolute value of the difference value of the x-axis coordinates of the two positions, and the device stops when the position is reached;
twenty-eight steps, are four distance measuring sensors on the truck side of the device all greater than the fourth setting value? Otherwise, alarming and stopping the machine, and turning to manual processing;
twenty-nine, slowly lowering the lifting appliance for a certain distance until the lifting appliance is lowered to a position to be sensed, wherein the Z-axis coordinate of the truck container is less than or equal to that of the truck container;
thirty, rotating the lifting appliance inwards by 90 degrees to enable the lifting hook to be separated from the beam of the container;
thirty-one, slowly lifting the lifting appliance for a certain distance, and quickly lifting the lifting appliance to the original point position of the z axis to stop;
step thirty-two, the telescopic fork is retracted to the middle position and the origin of the y axis; the action is ended.
Although the embodiments of the present invention have been described in conjunction with the accompanying drawings, those skilled in the art may make various modifications and variations without departing from the spirit and scope of the invention, and such modifications and variations fall within the scope defined by the appended claims.