CN211001601U - High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle - Google Patents
High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle Download PDFInfo
- Publication number
- CN211001601U CN211001601U CN201922097990.6U CN201922097990U CN211001601U CN 211001601 U CN211001601 U CN 211001601U CN 201922097990 U CN201922097990 U CN 201922097990U CN 211001601 U CN211001601 U CN 211001601U
- Authority
- CN
- China
- Prior art keywords
- walking
- controller
- vehicle
- system based
- deviation correcting
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000001514 detection method Methods 0.000 title claims description 13
- 238000004140 cleaning Methods 0.000 claims description 11
- 230000002567 autonomic effect Effects 0.000 abstract description 2
- 230000004888 barrier function Effects 0.000 abstract 1
- 230000002146 bilateral effect Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The utility model discloses a high accuracy straight line walking rectifying system and engineering vehicle based on two side distance detect, straight line walking rectifying system includes the controller and links to each other with the controller respectively about walking enable switch, control walking handle, speed sensor, display, ultrasonic sensor, ultrasonic wave keep away barrier sensor. The rotating speed sensor is installed on the left and right traveling motors, the ultrasonic sensors are installed at the front end, the middle part and the rear end of a central axis of the upper part of the vehicle body, the ultrasonic obstacle avoidance sensors are installed at the front end and the rear end of the vehicle body, the controller controls the left and right traveling motor electromagnetic valves by controlling the left and right traveling handles or the operation result of the controller, and the display is used for displaying traveling reference calibration, traveling deviation and traveling speed. The utility model discloses realize the autonomic straight line walking of automobile body and rectify.
Description
Technical Field
The utility model relates to a controlling means of tunnel cleaning robot specifically is a high accuracy straight line walking deviation correcting system based on two side distance detect, belongs to tunnel cleaning robot controlling means technical field.
Background
The tunnel cleaning robot is used for cleaning attachments on the inner wall of a tunnel, prevents excessive attachments and influences the normal use of the tunnel, harmful gas possibly exists in the tunnel, the tunnel cannot be cleaned manually, the tunnel cleaning robot is required to be cleaned mainly, accurate autonomous linear walking and automatic deviation correction in the cleaning process are very important, in the cleaning construction process, the cross section of the tunnel is arc-shaped, random attachments exist on the surface of the tunnel, random sundries exist at the bottom of the tunnel, walking deviation of a vehicle can occur in the cleaning process, or the vehicle can stop frequently due to overlarge deviation, construction efficiency is influenced, the inner wall of the tunnel can be collided even, and accidents of damaging the tunnel and equipment occur.
Disclosure of Invention
To the problem that above-mentioned prior art exists, the utility model provides a high accuracy straight line walking deviation correcting system based on two side distance detect realizes independently straight line walking and the deviation rectification of automobile body.
The utility model discloses realize according to following technical scheme:
the high-precision linear walking deviation correcting system based on the bilateral distance detection comprises a controller, a left walking enabling switch, a right walking enabling switch, a left walking handle, a right walking handle, a rotating speed sensor, a display, an ultrasonic sensor and an ultrasonic obstacle avoidance sensor, wherein the left walking enabling switch, the right walking handle, the rotating speed sensor, the display, the ultrasonic sensor and the ultrasonic obstacle avoidance sensor are respectively connected with the controller; the rotating speed sensor is arranged on the left and right traveling motors and is used for detecting the forward rotation speed and the reverse rotation speed of the traveling motors so as to obtain the traveling speeds of the left and right crawler belts; the ultrasonic sensors are arranged at the front end, the middle part and the rear end of a central axis of the upper part of the vehicle body and are used for detecting the distance between the vehicle body and two sides and providing signal feedback for automatic linear walking; the ultrasonic obstacle avoidance sensors are arranged at the front end and the rear end of the vehicle body and used for detecting obstacles in front of and behind the equipment so as to ensure the driving safety of the vehicle; the controller controls the left and right walking motor electromagnetic valve by controlling the left and right walking handles or the operation result of the controller, thereby realizing the control of the walking speed of the left and right crawler; the display is used for calibrating the walking reference, displaying the walking deviation and the walking speed; the left and right walking enabling switch is turned on, the left and right walking handles are manually operated to control the vehicle, the vehicle is adjusted to the central position of the tunnel according to the distance display values on the two sides of the display, the reference calibration is carried out, after the walking reference calibration is completed, the automatic walking mode can be switched through the display, the vehicle can go forward or backward by clicking, and the autonomous linear walking and the deviation correction of the vehicle body are realized.
Further, the straight line walking deviation rectifying system also comprises a chassis inclination angle sensor, and the deviation of the vehicle is compensated through a chassis inclination angle measured value.
Further, a 120 ohm resistor is connected between the controller and the chassis inclination angle sensor in parallel.
Further, the straight-line walking deviation correcting system also comprises a walking gear change-over switch, and the walking speed of the vehicle is changed over at low, medium and high speeds through the walking gear change-over switch, so that the vehicle can run at different reference speeds.
Further, the straight-line walking deviation correcting system also comprises a left crawler belt brake valve and a right crawler belt brake valve, and the walking safety of the left crawler belt and the right crawler belt is ensured through a left walking enabling switch and a right walking enabling switch and the left crawler belt brake valve and the right crawler belt brake valve.
Further, a 120 ohm resistor is connected between the controller and the display in parallel.
The engineering vehicle is provided with the high-precision straight-line walking deviation rectifying system based on the bilateral distance detection.
Further, the engineering vehicle comprises a tunnel cleaning robot.
The utility model discloses beneficial effect:
compared with the prior art, the utility model discloses a through installing in automobile body upper portion axis front end, the distance of the ultrasonic sensor detection automobile body and both sides of middle part and rear end, for automatic straight line walking provides signal feedback, calculate vehicle off tracking volume and off tracking angle through specific algorithm by the controller, and compensate vehicle off tracking volume through chassis inclination measured value, adjust the walking speed of controlling the track according to off tracking volume and off tracking angle, and then reach the purpose of high accuracy autonomic walking and automatic deviation rectification, and keep away the sensor through the ultrasonic wave of installing in the automobile body front and back end and detect preceding rear obstacle, in time report to the police and park, the high efficiency and the safety of clearance operation have been guaranteed.
Drawings
The accompanying drawings, which form a part of the present application, are included to provide a further understanding of the invention, and are incorporated in and constitute a part of this specification, illustrate embodiments of the invention and together with the description serve to explain the invention and not to limit the invention. In the drawings:
FIG. 1 is a schematic diagram of a portion of an electrical system of the present invention;
fig. 2 is a schematic view of a part of the structure of the present invention.
In the figure: 1. a controller, 2, a left walking enabling switch, 3, a right walking enabling switch, 4, a left walking handle, 5, a right walking handle, 6, a left crawler belt rotating speed sensor, 7, a right crawler belt rotating speed sensor, 8, a display, 9, a chassis inclination angle sensor, 10, a walking gear change-over switch, 11, a left crawler belt brake valve, 12, a right crawler belt brake valve, 13, the system comprises a left ultrasonic sensor 1, a right ultrasonic sensor 14, a right ultrasonic sensor 1, a left ultrasonic sensor 15, a left ultrasonic sensor 2, a right ultrasonic sensor 16, a right ultrasonic sensor 2, a left ultrasonic sensor 3, an ultrasonic sensor 18, a right ultrasonic sensor 3, a rear ultrasonic obstacle avoidance sensor 19, a left front ultrasonic obstacle avoidance sensor 20, a right front ultrasonic obstacle avoidance sensor 21, a right front ultrasonic obstacle avoidance sensor 22, a left track motor forward rotation electromagnetic valve 23, a left track motor reverse rotation electromagnetic valve 24, a right track motor forward rotation electromagnetic valve 25 and a right track motor reverse rotation electromagnetic valve.
Detailed Description
In order to make the purpose, technical solution and advantages of the present invention clearer, the following will combine the drawings in the embodiments of the present invention to perform more detailed description on the technical solution in the embodiments of the present invention. In the drawings, the same or similar reference numerals denote the same or similar elements or elements having the same or similar functions throughout. The described embodiments are only some, but not all embodiments of the invention. The embodiments described below with reference to the drawings are exemplary and intended to be used for explaining the present invention, and should not be construed as limiting the present invention. Based on the embodiments in the present invention, all other embodiments obtained by a person skilled in the art without creative work belong to the protection scope of the present invention. Embodiments of the present invention will be described in detail below with reference to the accompanying drawings.
As shown in fig. 1 to 2, a high-precision straight-line walking deviation rectifying system based on bilateral distance detection comprises a controller 1, and a left-right walking enabling switch, a left-right walking handle, a rotating speed sensor, a display 8, a chassis tilt angle sensor 9, a walking gear change-over switch 10, a left-right crawler brake valve, an ultrasonic sensor and an ultrasonic obstacle avoidance sensor which are respectively connected with the controller 1.
The rotating speed sensor is arranged on the left and right traveling motors and is used for detecting the forward rotation speed and the reverse rotation speed of the traveling motors so as to obtain the traveling speeds of the left and right crawler belts; the rotation speed sensors include a left track rotation speed sensor, and 7 and a right track rotation speed sensor.
The ultrasonic sensors are arranged at the front end, the middle part and the rear end of a central axis of the upper part of the vehicle body and are used for detecting the distance between the vehicle body and two sides and providing signal feedback for automatic linear walking; it should be noted that the front ultrasonic sensors of the central axis of the upper part of the vehicle body are a left 1 ultrasonic sensor 13 and a right 1 ultrasonic sensor 14; the ultrasonic sensors in the middle of the central axis of the upper part of the vehicle body are a left 2 ultrasonic sensor 15 and a right 2 ultrasonic sensor 16; the ultrasonic sensors at the rear end of the central axis of the upper part of the vehicle body are a left 3 ultrasonic sensor 17 and a right 3 ultrasonic sensor 18.
The ultrasonic obstacle avoidance sensors are arranged at the front end and the rear end of the vehicle body and used for detecting obstacles in front of and behind the equipment so as to ensure the driving safety of the vehicle; the ultrasonic obstacle avoidance sensors mounted at the front end of the vehicle body are a left front ultrasonic obstacle avoidance sensor 20 and a right front ultrasonic obstacle avoidance sensor 21, and the ultrasonic obstacle avoidance sensor mounted at the rear end of the vehicle body is a rear end ultrasonic obstacle avoidance sensor 19.
The controller 1 controls the left and right walking motor electromagnetic valves by controlling the left walking handle 4, the right walking handle 5 or the operation result of the controller 1, thereby realizing the control of the walking speed of the left and right crawler belts; the left and right travel motor solenoid valves include a left track motor normal rotation solenoid valve 22, a left track motor reverse rotation solenoid valve 23, a right track motor normal rotation solenoid valve 24, and a right track motor reverse rotation solenoid valve 25.
The display 8 is used for displaying the walking reference calibration, the walking deviation and the walking speed; the left walking enabling switch 2 and the right walking enabling switch 3 are turned on, the vehicle is controlled through the left walking handle 4 and the right walking handle 5 which are manually operated, the vehicle is adjusted to the central position of the tunnel according to the distance display values on the two sides of the display 8, the reference calibration is carried out, after the walking reference calibration is completed, the automatic walking mode can be switched through the display 8, the vehicle can be clicked to move forwards or backwards, and the autonomous linear walking and the deviation correction of the vehicle body can be realized.
With continued reference to fig. 1 and 2, the straight-line traveling deviation correcting system further includes a chassis inclination angle sensor 9 for compensating the deviation of the vehicle through a chassis inclination angle measurement value.
The straight-line walking deviation correcting system further comprises a walking gear selector switch 10, and the walking speed of the vehicle is switched between low speed, medium speed and high speed through the walking gear selector switch 10, so that the vehicle can run at different reference speeds.
The straight-line walking deviation rectifying system further comprises a left crawler belt brake valve 11 and a right crawler belt brake valve 12, and the safety of walking of the left crawler belt and the right crawler belt is guaranteed through a left walking enabling switch 2, a right walking enabling switch 3, the left crawler belt brake valve 11 and the right crawler belt brake valve 12.
Further scheme: and 120 ohm resistors are connected in parallel between the controller 1 and the chassis inclination angle sensor 9 and between the controller 1 and the display 8.
In summary, the ultrasonic sensors mounted on the central axis of the upper part of the vehicle body measure the distance between the vehicle body and the two sides, the controller 1 calculates the vehicle deviation and the deviation angle through a specific algorithm, compensates the vehicle deviation through the chassis inclination angle measurement value, and switches the traveling speed of the vehicle at low, medium and high speeds through the traveling gear selector switch 10, so that the vehicle can travel at different reference speeds, and the reference speeds of the left and right tracks are adjusted according to the deviation and the deviation angle, thereby achieving the purpose of autonomous deviation correction. The ultrasonic obstacle avoidance sensors are arranged at the front end and the rear end of the vehicle body, so that obstacles in the front and the rear of the vehicle body are detected, an alarm is given or the vehicle is stopped, the running safety of the vehicle is ensured, and the running safety of the left crawler belt and the right crawler belt is ensured through the left-right running enabling switch and the left-right crawler belt brake valve. The display 8 is used for displaying the walking reference calibration, the walking deviation and the walking speed; the left and right walking enabling switch is turned on, the left and right walking handles are manually operated to control the vehicle, the vehicle is adjusted to the central position of the tunnel according to the distance display values on the two sides of the display 8, the reference calibration is carried out, after the walking reference calibration is completed, the display can be switched to an automatic walking mode, the vehicle can go forward or backward by clicking, and the autonomous linear walking and the deviation correction of the vehicle body are realized.
The utility model also provides an engineering vehicle has foretell high accuracy straight line walking deviation correcting system based on two side distance detect. Wherein, this engineering vehicle includes tunnel cleaning robot.
Finally, it should be noted that the above embodiments are only used for illustrating the technical solutions of the present invention and not for limiting the same; although the present invention has been described in detail with reference to preferred embodiments, it should be understood by those skilled in the art that: the invention can be modified or equivalent substituted for some technical features; without departing from the spirit of the present invention, it should be understood that the scope of the claims is intended to cover all such modifications and variations.
Claims (9)
1. High accuracy straight line walking rectifying system based on two side distance detect, its characterized in that includes:
a controller;
the rotating speed sensor is electrically connected with the controller, is arranged on the left and right walking motors and is used for detecting the forward rotation speed and the reverse rotation speed of the walking motors so as to obtain the walking speeds of the left and right crawler belts;
the ultrasonic sensors are electrically connected with the controller, are arranged at the front end, the middle part and the rear end of the central axis of the upper part of the vehicle body, are used for detecting the distance between the vehicle body and the two sides and provide signal feedback for automatic linear walking;
the ultrasonic obstacle avoidance sensor is electrically connected with the controller, is arranged at the front end and the rear end of the vehicle body, and is used for detecting obstacles in front of and behind the equipment to ensure the running safety of the vehicle;
and the display is electrically connected with the controller and is used for displaying the walking reference calibration, the walking deviation and the walking speed.
2. The high-precision straight-line walking deviation correcting system based on double-side distance detection is characterized in that: the controller controls the left and right walking motor electromagnetic valves by controlling the left and right walking handles or the operation result of the controller, thereby realizing the control of the walking speed of the left and right crawler belts.
3. The high-precision straight-line walking deviation correcting system based on double-side distance detection is characterized in that: the straight line walking deviation rectifying system also comprises a chassis inclination angle sensor, and the deviation of the vehicle is compensated through a chassis inclination angle measured value.
4. The high-precision straight-line walking deviation correcting system based on double-side distance detection is characterized in that: and a 120 ohm resistor is connected in parallel between the controller and the chassis inclination angle sensor.
5. The high-precision straight-line walking deviation correcting system based on double-side distance detection is characterized in that: the straight line walking deviation correcting system also comprises a walking gear change-over switch, and the walking speed of the vehicle is switched between low speed, medium speed and high speed through the walking gear change-over switch, so that the vehicle can run at different reference speeds.
6. The high-precision straight-line walking deviation correcting system based on double-side distance detection is characterized in that: the straight-line walking deviation correcting system also comprises a left crawler belt brake valve and a right crawler belt brake valve, and the safety of left and right crawler belt walking is ensured through a left and right walking enabling switch and the left and right crawler belt brake valves.
7. The high-precision straight-line walking deviation correcting system based on double-side distance detection is characterized in that: and a 120 ohm resistor is connected in parallel between the controller and the display.
8. Engineering vehicle, its characterized in that: the high-precision straight-line walking deviation correcting system based on the double-side distance detection is provided with any one of claims 1 to 7.
9. The work vehicle of claim 8, wherein: the engineering vehicle comprises a tunnel cleaning robot.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201922097990.6U CN211001601U (en) | 2019-11-29 | 2019-11-29 | High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201922097990.6U CN211001601U (en) | 2019-11-29 | 2019-11-29 | High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN211001601U true CN211001601U (en) | 2020-07-14 |
Family
ID=71500458
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201922097990.6U Active CN211001601U (en) | 2019-11-29 | 2019-11-29 | High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN211001601U (en) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110775173A (en) * | 2019-11-29 | 2020-02-11 | 徐州徐工基础工程机械有限公司 | High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle |
| CN112660040A (en) * | 2021-02-01 | 2021-04-16 | 地晨环境技术(南京)有限公司 | Walking straightness correction method for drilling machine |
| CN115214811A (en) * | 2021-04-18 | 2022-10-21 | 河北农业大学 | A short-distance straight-line driving device |
-
2019
- 2019-11-29 CN CN201922097990.6U patent/CN211001601U/en active Active
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110775173A (en) * | 2019-11-29 | 2020-02-11 | 徐州徐工基础工程机械有限公司 | High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle |
| CN110775173B (en) * | 2019-11-29 | 2023-11-10 | 徐州徐工基础工程机械有限公司 | High-precision linear walking deviation correcting system based on bilateral distance detection and engineering vehicle |
| CN112660040A (en) * | 2021-02-01 | 2021-04-16 | 地晨环境技术(南京)有限公司 | Walking straightness correction method for drilling machine |
| CN115214811A (en) * | 2021-04-18 | 2022-10-21 | 河北农业大学 | A short-distance straight-line driving device |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110775173B (en) | High-precision linear walking deviation correcting system based on bilateral distance detection and engineering vehicle | |
| CN211001601U (en) | High-precision straight-line walking deviation correcting system based on double-side distance detection and engineering vehicle | |
| JP4165965B2 (en) | Autonomous work vehicle | |
| US8955865B2 (en) | Hitch system for steering vehicle for train | |
| US8457844B2 (en) | Parallel parking assistant system and method thereof | |
| CN101631712B (en) | Steering system and method for train of wheeled vehicles | |
| EP3900505B1 (en) | Control device for automatic travel work vehicle | |
| WO2015166705A1 (en) | Road-shoulder-detecting system and transportation vehicle for mining | |
| JP6699592B2 (en) | Steering control method for unmanned forklift | |
| US11155298B2 (en) | Modified steering angle at completion of hitch assist operation | |
| JP7390817B2 (en) | Traveling direction state detection device and trolley using the same | |
| US20220001942A1 (en) | Traveling Vehicle | |
| JP2006110207A (en) | Driving support control method for small electric vehicle | |
| CN103373407B (en) | The intelligent switch method of wheel robot leg and wheel leg | |
| JP2021149125A (en) | Autonomous moving device and autonomous moving device control method | |
| JP2786516B2 (en) | Work vehicle traveling method | |
| KR101449177B1 (en) | Active cruise control system | |
| CN111319625A (en) | Vehicle travel control system, vehicle, traction system, and vehicle travel control method | |
| JPWO2020090864A1 (en) | Handle angle controller | |
| JP2007122272A (en) | Moving device | |
| JPH02300803A (en) | Unmanned mobile body | |
| JP2862562B2 (en) | Traveling course and condition input device for moving objects | |
| JPH01207804A (en) | Self-traveling working vehicle | |
| JPS6215610A (en) | How to control the movement of an autonomous robot | |
| GB2398047A (en) | Tow bar length calculation |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| GR01 | Patent grant | ||
| GR01 | Patent grant |