Crawler stair climbing machine control method based on laser sensor and crawler stair climbing machine

By equipping the crawler stair climber with laser sensors, automatically identifying the stair environment and calculating standard distances, the problem of operating errors in complex working conditions is solved, safety and work efficiency are improved, and the cargo is transported smoothly.

CN119078879APending Publication Date: 2024-12-06XSTO (GUANGZHOU) CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411314916.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-20
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

Existing crawlers are difficult to work properly under complex working conditions, and the staff's operating level is insufficient and can easily lead to safety problems, especially when you need to go up and down stairs repeatedly during cargo handling, operating errors are prone to occur.

Method used

By equipping the crawler stair climber with laser sensors, the stair environment characteristics are automatically identified, and the built-in control method is combined to realize automatic control, and the standard distance is calculated to determine whether to lower the support wheels, ensuring the stable operation of the machine under complex working conditions.

Benefits of technology

It effectively avoids the risk of crawler climbing machines dumping under complex working conditions, improves work efficiency and safety, and can accurately identify and handle stairs of the opposite sex, ensuring the smooth transportation of goods.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119078879A_ABST
    Figure CN119078879A_ABST
Patent Text Reader

Abstract

The invention discloses a crawler stair-climbing machine control method based on a laser sensor and a crawler stair-climbing machine, relates to the technical field of auxiliary carrying equipment, and solves the technical problems that an existing crawler stair-climbing machine is difficult to work normally under complex working conditions, and the safety is affected due to misoperation when the operation level of workers is insufficient. The method comprises the following steps: calculating a standard distance according to a supporting point position of the crawler stair-climbing machine and a setting position and a setting angle of a laser sensor; in the running process of the crawler stair-climbing machine, once the measured distance is larger than or equal to the standard distance, the supporting wheels are put down to prevent the crawler stair-climbing machine from toppling over, and at the moment, the crawler runs to complete the stair-climbing action; the crawler stair climbing machine can cope with various working conditions, the situation that the crawler stair climbing machine topples forwards when carrying heavy objects to the last step can be avoided, special-shaped stairs can be accurately recognized and processed, and the working efficiency of the crawler stair climbing machine is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application belongs to the field of auxiliary handling equipment, and specifically relates to a crawler stair climbing machine control method based on a laser sensor and a crawler stair climbing machine. Background Art

[0002] In the process of moving goods, there are often goods that need to be moved through stairs during the process of moving. The movers need to go up and down the stairs repeatedly to complete the moving of goods, which brings a great burden to the movers. The crawler stair climbing machine can use electromechanical technology to move goods up and down the stairs, greatly improving the convenience of cargo moving.

[0003] Existing crawler stair climbing machines are usually driven by motors or hydraulic systems to provide power for crawlers to go up or down stairs. However, in the process of cargo handling, it is inevitable to encounter some complex working conditions. When the crawler stair climbing machine cannot work in complex working conditions, manual operation is required. This requires the staff to be proficient in operating the machine and familiar with the stair environment. Otherwise, it is easy to make mistakes in operation and cause safety problems.

[0004] The present application provides a crawler stair climbing machine control method and a crawler stair climbing machine based on a laser sensor to solve the above-mentioned technical problems. Summary of the invention

[0005] The present application aims to solve at least one of the technical problems existing in the prior art; to this end, the present application proposes a crawler stair climber control method and a crawler stair climber based on a laser sensor, which are used to solve the technical problems that the existing crawler stair climbers are difficult to work normally under complex working conditions, and are prone to operating errors that affect safety when the operating level of the staff is insufficient. The present application solves the above problems by equipping the crawler stair climber with a laser sensor to automatically identify the stair environment, and combining it with a built-in control method to achieve automatic control.

[0006] To achieve the above-mentioned purpose, the first aspect of the present application provides a control method of a crawler stair climbing machine based on a laser sensor, comprising:

[0007] The environmental characteristics of the target staircase are collected by a laser sensor arranged in the crawler stair climbing machine; wherein the environmental characteristics include the position, shape and layout of the stair steps;

[0008] The standard distance is calculated according to the setting parameters of the laser sensor and the angle of the stairs; wherein the setting parameters include the offset angle, the offset distance and the standard support distance, and the standard support distance is the distance between the support point of the support wheel and the intersection point of the laser sensor and the horizontal plane when the crawler stair climber is horizontal;

[0009] When the measured distance of the laser sensor is greater than or equal to the standard distance, the crawler stair climbing machine is controlled to lower the supporting wheels; after the supporting wheels complete the support, the crawler is run again.

[0010] Preferably, the step of calculating the standard distance according to the setting parameters of the laser sensor and the angle of the stairs includes:

[0011] The offset angle and stair angle are set to θ1 and θ2 respectively, and the standard support distance and offset distance are set to L1 and L2 respectively; wherein the offset angle is the angle between the laser sensor and the horizontal direction, and the offset distance is the distance between the laser sensor and the horizontal plane in the direction of the laser optical path when the crawler stair climbing machine is horizontal;

[0012] The standard distance L is calculated by the formula L=L1×sin(θ2) / cos(θ1+θ2)+L2.

[0013] Preferably, a plurality of the laser sensors are arranged on the crawler stair climbing machine, and the laser sensors jointly collect and identify the environmental features.

[0014] Preferably, when the measurement distance of the laser sensor suddenly increases, it is determined that the crawler stair climbing machine has run to a hollow staircase, and the measured distance is filtered.

[0015] Preferably, before controlling the crawler stair climbing machine to lower the support wheels, the method further comprises:

[0016] When the measured distance is equal to the distance threshold, the crawler stair climbing machine is speed-limited to prevent the crawler stair climbing machine from tipping over; wherein the distance threshold is less than the standard distance.

[0017] A second aspect of the present application provides a crawler stair climbing machine, comprising a drive motor and a laser sensor;

[0018] Drive motor: used to achieve precise control of speed and torque through field-oriented control drive technology;

[0019] Laser sensor: used to detect and collect the environmental characteristics of the target stairs.

[0020] Compared with the prior art, the beneficial effects of the present application are as follows: the present application first calculates the standard distance based on the support points of the crawler stair climber and the setting position and angle of the laser sensor; during the operation of the crawler stair climber, once the measured distance is greater than or equal to the standard distance, the support wheels are lowered to prevent the crawler stair climber from tipping over, and then the crawler is run again to complete the climbing action; the present application can cope with various working conditions, not only can it prevent the crawler stair climber from tipping forward when carrying heavy objects to the last step, but it can also accurately identify and handle irregular stairs, thereby improving the working efficiency of the crawler stair climber. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] In order to more clearly illustrate the embodiments of the present application 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 application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0022] Figure 1 A schematic diagram of the control principle of an embodiment of the present application;

[0023] Figure 2 This is a schematic diagram of the horizontal placement of the crawler stair climbing machine in the embodiment of the present application;

[0024] Figure 3 A schematic diagram of a crawler stair climbing machine running on a target stair in an embodiment of the present application;

[0025] Figure 4 This is a schematic diagram of the crawler stair climbing machine in the embodiment of the present application lowering the support wheels on the last step.

[0026] In the figure, 1. Track; 2. Laser sensor; 3. Support wheel. DETAILED DESCRIPTION

[0027] The technical solution of the present application will be described clearly and completely in conjunction with the embodiments below. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present application.

[0028] See also Figure 1 The first embodiment of the present application provides a crawler stair climbing machine control method based on a laser sensor 2, comprising:

[0029] The environmental characteristics of the target stairs are collected by the laser sensor 2 installed in the crawler stair climbing machine; the standard distance is calculated according to the setting parameters of the laser sensor 2 and the angle of the stairs; when the measured distance of the laser sensor 2 is greater than or equal to the standard distance, the crawler stair climbing machine is controlled to lower the support wheel 3; after the support wheel 3 completes the support, the crawler 1 is re-operated.

[0030] The environmental features in this embodiment include the location, shape and layout of the stair steps. After data processing, the distance between the laser sensor 2 and the target can be determined. Of course, the detection data of the laser sensor 2 can also be used to identify the situation in the corresponding area of ​​the crawler stair climber, such as whether there are obstacles and whether the space is large enough for the crawler stair climber to operate. It should be noted that the purpose of obtaining environmental features is mainly to determine whether the crawler stair climber has reached the last step. If it has reached the last step, it is necessary to determine whether the support wheels need to be lowered; or to determine whether it is an irregular staircase, such as a hollow staircase. If it is a hollow staircase, the data needs to be filtered. The specific implementation process of these two aspects is described in detail in the subsequent content of the embodiment.

[0031] In this embodiment, the setting parameters are mainly used to determine the relative position of the laser sensor 2 on the crawler stair climber, so as to calculate the relative position of the stairs and the crawler stair climber in combination with the size of the crawler stair climber. The setting parameters specifically include the offset angle, the offset distance and the standard support distance.

[0032] The offset angle refers to the angle between the installation plane of the laser sensor 2 and the horizontal plane in the forward direction of the crawler stair climber when the crawler stair climber is horizontal. That is, the direction of the laser light path emitted by the laser sensor 2 is not perpendicular or parallel to the horizontal plane, but forms a certain angle with the horizontal plane. This setting can ensure the crawler stair climber's detection effect on the steps during its forward movement.

[0033] The offset distance is used to indicate the relative relationship between the laser sensor 2 and the horizontal plane when the crawler stair climber is horizontal, but it is not the vertical distance between the laser sensor 2 and the horizontal plane; when the crawler stair climber is horizontal, the laser light path of the laser sensor 2 will form an angle with the horizontal plane, that is, the laser light path will form an intersection with the plane where the crawler stair climber is located, that is, the intersection point. The offset distance refers to the distance between the intersection point and the laser sensor 2. It can be understood that when the crawler stair climber is on a horizontal plane, the measurement distance of the laser sensor 2 is equal to the offset distance.

[0034] The standard support distance is the distance between the support point of the crawler stair climber when it is horizontal and the intersection point of the laser sensor 2 and the horizontal plane. The standard support distance is fixed for each crawler stair climber, that is, whether it is in horizontal operation or in the process of climbing stairs, the standard support distance of the crawler stair climber is fixed.

[0035] The support point in this implementation actually refers to the center of gravity balance point of the crawler stair climber. It can be understood that when the crawler stair climber is supported at the center of gravity balance point, the weight on both sides of the corresponding support point is the same. When the crawler stair climber climbs to the last step and the crawler 1 contacts the last step, if it continues to go up at this time, the front end of the crawler 1 of the crawler stair climber will directly hit the platform under the action of gravity due to the forward center of gravity. At this time, the support wheel 3 of the crawler stair climber needs to be lowered to ensure that the machine does not tip forward.

[0036] It should be noted that although the present embodiment takes the last step as an example, in fact, the crawler stair climbing machine controlled by the above control method is applicable to all steps in the target staircase, and the function of the support wheel 3 is mainly played on the last step, and the conventional staircase generally does not need to lower the support wheel 3. However, for some special-shaped stairs, such as when the step plane is too large, in order to ensure the balance of the crawler stair climbing machine, the support wheel 3 still needs to be lowered to avoid tipping.

[0037] During the stair climbing process of the crawler stair climber, the laser sensor 2 installed on it scans in real time and identifies the working environment based on the scanned data, such as the position, shape and layout of the stair steps. The laser sensor 2 also has an important task, which is to measure the distance to the target. During the process of crawler 1 climbing the stairs, due to the specific position of the laser sensor 2, the position of the target on the forward path can be measured in real time, and then the measured distance between the laser sensor 2 and the target can be calculated. When the measured distance is greater than or equal to the standard distance, the support legs of the crawler stair climber need to be lowered, and the crawler 1 needs to be operated after the support legs are stable to complete the stair climbing action.

[0038] In this embodiment, the standard distance is calculated based on the stair angle and the setting parameters of the laser sensor 2. The specific calculation formula is L=L1×sin(θ2) / cos(θ1+θ2)+L2 to calculate the standard distance L; θ1 and θ2 are the offset angle and stair angle respectively, and L1 and L2 are the standard support distance and offset distance respectively.

[0039] See also Figure 2 When the crawler stair climbing machine is on a horizontal plane, the crawler 1 is divided into two sections, one section is parallel to the horizontal plane, and the other section is at a certain angle to the horizontal plane. The angle is determined by testing the crawler stair climbing machine under various working conditions. A laser sensor 2 is set at the top of the second crawler 1. The setting of the laser sensor 2 will not affect the normal operation of the crawler 1, and because the standard example can be calculated by the conversion of the trigonometric relationship, the position of the laser sensor 2 can be flexibly set. Figure 2 Where L2 is the measured distance of laser sensor 2 along the laser emission direction. Laser sensor 2 is tilted and its angle with the horizontal plane is θ1. Figure 3, is the state where the crawler stair climbing machine is on the target staircase with a stair angle of θ2.

[0040] It should be noted that the standard distance is the distance measured by the laser sensor 2 when the crawler stair climber reaches the last step and the center of gravity balance point contacts the last step. The standard distance can be calculated by the installation angle of the laser sensor 2 and the angle of the stairs detected when climbing the stairs, after the trigonometric transformation in the above formula. When the measured distance detected by the laser sensor 2 is greater than or equal to the standard distance, it means that the crawler 1 has run beyond the center of gravity balance point on the stairs. At this time, the crawler stair climber is at risk of tipping forward and needs to lower the support wheels 3 for support. Please refer to Figure 4 When the measured distance is less than the standard distance, it means that the crawler 1 has not yet reached the center of gravity balance point on the stairs. At this time, the crawler stair climbing machine will not have the risk of tilting forward and does not need the assistance of the support wheel 3. It should be noted that Figure 4 3 is the support wheel 3 of the crawler stair climbing machine, and the support wheel 3 can be put down or retracted.

[0041] In some preferred embodiments, multiple laser sensors 2 can be set on the crawler stair climbing machine, and the calculation formula of the standard distance can be adaptively adjusted according to the setting parameters of each laser sensor 2. By setting multiple laser sensors 2, on the one hand, the data between the laser sensors 2 can be mutually verified to avoid abnormal data affecting the control of the crawler stair climbing machine, and on the other hand, the redundant laser sensors 2 are designed as redundancy, and if any laser sensor 2 fails, the data of other laser sensors 2 can be used to complete the control.

[0042] Taking into account the various types of stairs, the above technical solution cannot identify hollow stairs well. Therefore, in some preferred embodiments, it can be determined whether the measured distance of the laser sensor 2 increases suddenly. If the measured distance increases suddenly, it is determined that the crawler stair climbing machine runs to the hollow stairs, and the measured distance this time can be filtered, that is, the abnormal data is not considered. Taking into account the characteristics of hollow stairs, the sudden increase in the measured distance here refers to whether the value changes suddenly relative to the previous measurement result or the next measurement result, that is, the value becomes larger and is discontinuous with the previous or the next measurement result. Reference Figure 3 or Figure 4 If the step is hollow, the measurement distance L2 of the laser sensor 2 will undergo an abnormal mutation.

[0043] The second embodiment of the present application provides a crawler stair climbing machine, comprising:

[0044] Drive motor: used to achieve precise control of speed and torque through field-oriented control drive technology;

[0045] Laser sensor 2: used to detect and collect environmental characteristics of the target stairs.

[0046] The drive motor adopts high-efficiency, low-noise design, has high torque output, and can adapt to various complex road conditions. The drive motor adopts FOC (Field Oriented Control) drive technology to achieve precise control of speed and torque, and improve driving stability and safety. FOC technology achieves precise control of motor torque and magnetic field by independently controlling the magnetic field and current of the motor, thereby improving the dynamic response and efficiency of the motor. The crawler 1 of the crawler stair climbing machine in this embodiment can distribute power during the climbing process and improve the anti-skid performance.

[0047] The laser sensor 2 is used to detect and collect the environmental parameters of the stairs. It emits lasers, receives the reflected lasers, and calculates the time difference or phase difference of the lasers to determine the distance between the target and the sensor. Through the data obtained by the laser sensor 2, the stair climber can adjust the track 1 or the support wheel 3 in real time to adapt to steps of different sizes and shapes. The stair climber can identify the position, shape and layout of the steps, which helps the stair climber maintain stability during the climbing process. The laser sensor 2 can also monitor the motion state and posture of the stair climber in real time. By working in conjunction with the gyroscope and accelerometer, the laser sensor 2 can provide more comprehensive and accurate motion data. These data can be used to adjust the motion parameters of the stair climber, such as speed, acceleration and attitude angle, in real time to ensure that it maintains the best motion state during the climbing process. Combined with real-time sensor data, the device can determine its precise position and direction on the stairs, so as to perform tasks or guide users more accurately.

[0048] The above embodiments are only used to illustrate the technical method of the present application and are not intended to limit it. Although the present application has been described in detail with reference to the preferred embodiments, a person of ordinary skill in the art should understand that the technical method of the present application may be modified or replaced by equivalents without departing from the spirit and scope of the technical method of the present application.

Claims

1. A crawler stair climbing machine control method based on a laser sensor, characterized in that: include: The laser sensor installed in the crawler stair climbing machine collects the environmental characteristics of the target stairs, wherein the environmental characteristics include the position, shape and layout of the stair steps; The standard distance is calculated according to the setting parameters of the laser sensor and the angle of the stairs; wherein the setting parameters include the offset angle, the offset distance and the standard support distance, and the standard support distance is the distance between the support point of the support wheel and the intersection point of the laser sensor and the horizontal plane when the crawler stair climber is horizontal; When the measured distance of the laser sensor is greater than or equal to the standard distance, the crawler stair climbing machine is controlled to lower the supporting wheels; after the supporting wheels complete the support, the crawler is run again.

2. The laser sensor-based crawler stair climbing machine control method according to claim 1, characterized in that: The method of calculating the standard distance according to the setting parameters of the laser sensor and the angle of the stairs includes: The offset angle and stair angle are set to θ1 and θ2 respectively, and the standard support distance and offset distance are set to L1 and L2 respectively; wherein the offset angle is the angle between the laser sensor and the horizontal direction, and the offset distance is the distance between the laser sensor and the horizontal plane in the direction of the laser optical path when the crawler stair climbing machine is horizontal; The standard distance L is calculated by the formula L=L1×sin(θ2) / cos(θ1+θ2)+L2.

3. The control method of crawler stair climbing machine based on laser sensor according to claim 1 is characterized in that: A plurality of laser sensors are arranged on the crawler stair climbing machine, and the laser sensors jointly collect and identify the environmental features.

4. The laser sensor-based crawler stair climbing machine control method according to claim 1, characterized in that: When the measurement distance of the laser sensor suddenly increases, it is determined that the crawler stair climbing machine has run to a hollow staircase, and the measurement distance is filtered.

5. The control method of crawler stair climbing machine based on laser sensor according to claim 1, characterized in that: Before controlling the crawler stair climbing machine to lower the supporting wheels, the method further comprises: When the measured distance is equal to the distance threshold, the crawler stair climbing machine is speed-limited to prevent the crawler stair climbing machine from tipping over; wherein the distance threshold is less than the standard distance.

6. A crawler stair climbing machine, controlled by the crawler stair climbing machine control method based on laser sensor according to any one of claims 1 to 5, characterized in that: Including drive motor and laser sensor; Drive motor: used to achieve precise control of speed and torque through field-oriented control drive technology; Laser sensor: used to detect and collect the environmental characteristics of the target stairs.