A skid loader and unmanned driving method thereof
By using angle sensors, cameras, lidar and inertial navigation systems on the skid loader, combined with the autonomous driving domain controller, the automatic shoveling and lifting of the skid loader is realized, solving the key problems of unmanned driving. Ensure the safety and health of the operators.
Patent Information
- Application Number
- CN202111188608.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-10-12
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2041-10-12
AI Technical Summary
Existing skid loaders cannot achieve automatic shoveling and automatic lifting and unloading, and the safety and health of drivers are threatened in high-risk and high-intensity working environments.
The first angle sensor and the second angle sensor are used to detect the angles of the bucket and boom, and combined with the camera, lidar and inertial navigation system, the information is collected and processed through the autonomous driving domain controller to realize unmanned driving of the skid loader.
The automatic shoveling and automatic lifting of the skid loader is realized, ensuring the safety and health of the operators and reducing labor costs.
Smart Images

Figure CN113833042B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of engineering machinery, and in particular to a skid loader and an unmanned driving method thereof. Background Art
[0002] A skid loader, also known as a skid-type loader, a multifunctional engineering vehicle, or a multifunctional engineering machine, is a wheeled special chassis device that uses the linear speed difference of the wheels on both sides to achieve vehicle steering. Since the minimum turning radius of a skid loader is less than half of that of an ordinary loader of the same level, it can almost achieve on-site steering, and is particularly suitable for operations in narrow places such as urban infrastructure, roads or construction sites, factory workshops, warehouses, docks, ship decks, and even cabins.
[0003] Current skid steer loaders require operators to sit in the cockpit to operate them. However, when encountering dangerous places such as high temperature, high corrosion, and flammable and explosive places, the personal safety of the driver is often not guaranteed. At the same time, some working conditions require 24-hour uninterrupted work. Long-term fatigue work of drivers is not conducive to their health. In addition, the generally harsh environment of the workplace will also affect the health of the driver. Therefore, there is an urgent need for a skid steer loader that can be unmanned. To realize the unmanned driving of a skid steer loader, it is necessary to solve many problems such as how to automatically shovel and unload, how to judge the surrounding environment, how to conduct real-time position, speed, and direction monitoring, and how to perform automatic control. Summary of the invention
[0004] The present invention solves the technical problem that the skid steer loader in the prior art cannot realize automatic shoveling and automatic lifting and unloading, and proposes a skid steer loader and an unmanned driving method thereof, which can realize automatic shoveling and automatic lifting and unloading of the skid steer loader.
[0005] The technical solution of the present invention:
[0006] A skid steer loader, comprising:
[0007] a first angle sensor, the first angle sensor being configured on the bucket of the skid steer loader and configured to detect an angle of the bucket and send a detected first angle signal to a controller;
[0008] a second angle sensor, the second angle sensor being arranged on the boom of the skid steer loader and configured to detect an angle of the boom and send a detected second angle signal to a controller;
[0009] A controller is provided for controlling the movement of a bucket, a boom and wheels of the skid steer loader according to the first angle signal and the second angle signal.
[0010] Furthermore, the skid loader is provided with four cameras, which are respectively installed in the front, back, left and right directions of the skid loader. The four cameras respectively capture images of the skid loader in the front, back, left and right directions and transmit the images to the controller.
[0011] Furthermore, a blink controller is installed on the skid loader, and the images captured by the four cameras are processed by the blink controller and the driving scene signal is sent to the controller.
[0012] Furthermore, the skid loader is also provided with three laser radars, which are respectively installed at the left front, right front and middle rear positions of the top of the skid loader to perform 360-degree detection of the surrounding object information of the skid loader and send radar detection signals to the controller.
[0013] Furthermore, the skid loader is also equipped with an inertial navigation system, which detects the position, direction, speed and posture information of the skid loader in real time and sends the inertial navigation detection signal to the controller.
[0014] Furthermore, the controller is an autonomous driving domain controller.
[0015] Furthermore, the first angle signal, the second angle signal, the driving scene signal, the radar detection signal and the inertial navigation detection signal are sent to the autonomous driving domain controller via the 5G industrial gateway.
[0016] Another aspect of the present invention provides an unmanned driving method for a skid loader, comprising the following steps:
[0017] Acquiring working status information of the bucket and boom of the skid loader through an angle sensor;
[0018] Acquiring driving scene information of the skid loader through a camera;
[0019] Acquiring information about objects around the skid loader through a laser radar;
[0020] Acquiring the position, direction, speed and attitude information of the skid loader through inertial navigation;
[0021] The above information is collected by the autonomous driving domain controller, data processing is performed, the whole machine operation strategy is formulated, and the whole machine operation signal is converted into the whole machine operation signal and transmitted to the electronic control operating system of the skid loader, thereby realizing unmanned driving of the skid loader.
[0022] After adopting the above technical solution, the present invention has the following beneficial effects compared with the prior art:
[0023] 1. The present invention detects the angles of the bucket and the boom by setting a first angle sensor and a second angle sensor, and sets four sets of corresponding angle preset values corresponding to the four working states of shoveling, collecting, lifting, and unloading, so that the skid loader can realize automatic shoveling and automatic lifting and unloading. In addition, the detected first angle signal and the second angle signal are sent to the controller, which solves the problem of automatic shoveling and automatic lifting and unloading in the automatic driving of the skid loader, thereby facilitating the unmanned operation of the skid loader.
[0024] 2. The present invention collects information collected by the first angle sensor, the second angle sensor, the camera, the lidar and the inertial navigation by setting up an automatic driving domain controller, processes the data, formulates a whole machine operation strategy, and converts the whole machine operation signal into the electronic control operating system of the skid loader, thereby realizing unmanned driving of the skid loader. BRIEF DESCRIPTION OF THE DRAWINGS
[0025] Figure 1 Schematic diagram of the installation positions of various components on the skid steer loader of this embodiment;
[0026] Figure 2 Schematic diagram of the connection relationship of various components on the skid loader of this embodiment;
[0027] Figure 3 It is a schematic diagram of signal transmission of the skid steer loader of this embodiment.
[0028] in,
[0029] First angle sensor 1, bucket 11, second angle sensor 2, boom 21, camera 3, blink controller 4, lidar 5, inertial navigation 6, 5G industrial gateway 7, autonomous driving domain controller 8, skid loader 9. DETAILED DESCRIPTION
[0030] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments. The following description of at least one exemplary embodiment is actually only illustrative and is by no means intended to limit the present invention and its application or use. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0031] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present application. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprise" and / or "include" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.
[0032] Unless otherwise specifically stated, the relative arrangement of the parts and steps described in these embodiments, numerical expressions and numerical values do not limit the scope of the present invention. At the same time, it should be understood that, for ease of description, the sizes of the various parts shown in the accompanying drawings are not drawn according to the actual proportional relationship. The technology, method and equipment known to ordinary technicians in the relevant field may not be discussed in detail, but in appropriate cases, the technology, method and equipment should be regarded as a part of the authorization specification. In all examples shown and discussed here, any specific value should be interpreted as being merely exemplary, rather than as a limitation. Therefore, other examples of exemplary embodiments may have different values. It should be noted that similar reference numerals and letters represent similar items in the following drawings, so once a certain item is defined in an accompanying drawing, it does not need to be further discussed in subsequent drawings.
[0033] In the description of the present invention, it is necessary to understand that the directions or positional relationships indicated by directional words such as "front, back, up, down, left, right", "lateral, vertical, perpendicular, horizontal" and "top, bottom" are usually based on the directions or positional relationships shown in the drawings. They are only for the convenience of describing the present invention and simplifying the description. Unless otherwise specified, these directional words do not indicate or imply that the devices or elements referred to must have a specific direction or be constructed and operated in a specific direction. Therefore, they cannot be understood as limiting the scope of protection of the present invention. The directional words "inside and outside" refer to the inside and outside relative to the contours of each component itself.
[0034] For ease of description, spatially relative terms such as "above", "above", "on the upper surface of", "above", etc. may be used here to describe the spatial positional relationship between a device or feature and other devices or features as shown in the figure. It should be understood that spatially relative terms are intended to include different orientations of the device in use or operation in addition to the orientation described in the figure. For example, if the device in the accompanying drawings is inverted, the device described as "above other devices or structures" or "above other devices or structures" will be positioned as "below other devices or structures" or "below other devices or structures". Thus, the exemplary term "above" can include both "above" and "below". The device can also be positioned in other different ways (rotated 90 degrees or in other orientations), and the spatially relative descriptions used here are interpreted accordingly.
[0035] In addition, it should be noted that the use of terms such as "first" and "second" to limit components is only for the convenience of distinguishing the corresponding components. If not otherwise stated, the above terms have no special meaning and therefore cannot be understood as limiting the scope of protection of the present invention.
[0036] like Figure 1-3 As shown, the present invention provides a skid loader 9, including a first angle sensor 1 and a second angle sensor 2, wherein the first angle sensor 1 is configured on the bucket 11 of the skid loader 9, for detecting the angle of the bucket 11, and sending the detected first angle signal to a controller; the second angle sensor 2 is configured on the boom 21 of the skid loader 9, for detecting the angle of the boom 21, and sending the detected second angle signal to the controller, and the controller controls the movement of the bucket 11, the boom 21 and the wheels of the skid loader 9 according to the received first angle signal and the second angle signal.
[0037] In this embodiment, the angle of the bucket 11 is detected by the first angle sensor 1, and the angle of the boom 21 is detected by the second angle sensor 2. When the skid loader 9 transports materials from a stockpile point to a target location such as a transport vehicle, it is necessary to perform operations such as shoveling, collecting, lifting, and unloading. Corresponding to these four working states, the first angle sensor 1 and the second angle sensor 2 have four sets of corresponding angle preset values. After the skid loader 9 moves to the stockpiling point, the angles of the bucket 11 and the boom 21 are first detected by the first angle sensor 1 and the second angle sensor 2. When the angles of the bucket 11 and the boom 21 reach the first set of preset values, the controller controls the wheels of the skid loader 9 to move forward to perform the shoveling operation; when the shoveling operation is completed, the angles of the bucket 11 and the boom 21 are controlled to reach the second set of preset values, and the collection operation is performed, and then the skid loader 9 will move; when the skid loader 9 moves the material to the target position, the angles of the bucket 11 and the boom 21 are first detected by the first angle sensor 1 and the second angle sensor 2. When the angles of the bucket 11 and the boom 21 reach the third set of preset values, the controller controls the boom 21 of the skid loader 9 to lift and perform the lifting operation; after the lifting operation is completed, the angles of the bucket 11 and the boom 21 are controlled to reach the fourth set of preset values, and the unloading operation is performed.
[0038] In this way, this embodiment detects the angles of the bucket 11 and the boom 21 by setting the first angle sensor 1 and the second angle sensor 2, and sets four sets of corresponding preset values corresponding to the four working states of shoveling, collecting, lifting, and unloading, so that the skid loader 9 can realize automatic shoveling and automatic lifting and unloading. For example, an automatic shoveling button and an automatic lifting and unloading button can be set on the skid loader 9. After moving to the stockpile point, the automatic shoveling button is pressed to automatically shovel, and after moving to the target position, the automatic lifting and unloading button is pressed to automatically lift and unload, which can reduce the driver's workload to a certain extent during long-term operations. In addition, more importantly, by setting the first angle sensor 1 and the second angle sensor 2 to detect the angles of the bucket 11 and the boom 21, the detected first angle signal and the second angle signal are sent to the controller through the 5G industrial gateway 7, which solves the problem of automatic shoveling and automatic lifting and unloading in the automatic driving of the skid loader 9, thereby facilitating the unmanned operation of the skid loader 9.
[0039] like Figure 1-2As shown, in this embodiment, four cameras 3 are further provided on the skid loader 9, and the four cameras 3 are respectively installed in the front, back, left, and right directions of the skid loader 9. The four cameras 3 respectively capture video images in the front, back, left, and right directions of the skid loader 9 to simulate the driver's perspective, and transmit the images directly or indirectly to the controller. Preferably, a blink controller 4 is also installed on the skid loader 9, and the blink controller 4 analyzes and processes the images captured by the four cameras 3, determines and identifies the real-time working environment of the skid loader 9, and then sends the processed driving scene signal to the controller through the 5G industrial gateway 7.
[0040] Furthermore, three laser radars 5 are provided on the skid loader 9, and the three laser radars 5 are respectively installed at the left front, right front and middle rear positions of the top of the skid loader 9. The scanning and recognition angles of each laser radar 5 are set to perform 360-degree detection of the surrounding object information of the skid loader 9. The laser radar 5 emits a laser signal around the skid loader 9, then receives the reflected laser signal and compares it with the emitted laser signal to detect the distance between the surrounding objects and the skid loader 9 in real time, and sends the radar detection signal to the controller through the 5G industrial gateway 7. The controller can accurately determine the position of the skid loader 9 by fusing it with the image collected by the above-mentioned camera 3, so as to facilitate the positioning and obstacle avoidance of the skid loader 9.
[0041] Furthermore, an inertial navigation system 6 is installed on the skid loader 9. The inertial navigation system 6 belongs to the dead reckoning navigation mode, that is, the position of the next point is deduced from the position of a known point according to the continuously measured heading angle and speed of the moving body, so that the current position of the moving body can be continuously measured. The gyroscope in the inertial navigation system 6 is used to form a navigation coordinate system, so that the measuring axis of the accelerometer is stabilized in the coordinate system, and the heading and attitude angle are given; the accelerometer is used to measure the acceleration of the moving body, and the speed is obtained by integrating it once over time, and the displacement can be obtained by integrating the speed once over time. In this way, the inertial navigation system 6 can obtain the real-time, stable and continuous position, direction, speed and attitude information in the navigation coordinate system by measuring the acceleration of the skid loader 9 in the inertial reference system, integrating it over time, and transforming it into the navigation coordinate system, and these inertial navigation detection signals are sent to the controller through the 5G industrial gateway 7.
[0042] Preferably, the controller of this embodiment is an autonomous driving domain controller 8. The above-mentioned first angle signal, second angle signal, driving scene signal, radar detection signal and inertial navigation detection signal are sent to the autonomous driving domain controller 8 via the 5G industrial gateway 7. The autonomous driving domain controller 8 processes these signals, formulates a whole machine operation strategy, and converts them into whole machine operation signals, which are transmitted to the electronic control operating system of the skid loader 9 to realize the operation of the skid loader 9, and finally realize the unmanned driving of the skid loader 9. The information collected by all sensors can be centrally processed by the autonomous driving domain controller 8, without the need for a large number of electronic control units, simplifying the lines and facilitating control. Through the 5G industrial gateway 7, a 5G local area network is established in the environment where the skid loader 9 is running. Relying on the high speed and low latency of 5G, all the above-mentioned signals are guaranteed to be stably and real-timely transmitted to the autonomous driving domain controller 8.
[0043] This embodiment also provides an unmanned driving method for a skid loader, comprising the following steps:
[0044] Obtain working status information of the bucket 11 and the boom 21 of the skid loader 9 through the angle sensor, and transmit the working status information to the autonomous driving domain controller 8 through the 5G industrial gateway 7;
[0045] The driving scene information of the skid loader 9 is obtained through the camera 3. The camera 3 can be set at different positions of the skid loader 9 to capture the scene signal. Then, the captured scene signal is analyzed by the blink controller 4 to judge and identify the real-time working environment of the skid loader 9, obtain accurate driving scene information, and transmit it to the autonomous driving domain controller 8 through the 5G industrial gateway 7;
[0046] The laser radar 5 obtains information about objects around the skid loader 9. The laser radar 5 can emit and receive high-frequency laser beams and perform 3D imaging through 360-degree rotation, so that the skid loader 9 can obtain reliable information about the surrounding environment and transmit it to the autonomous driving domain controller 8 through the 5G industrial gateway 7 to provide guarantees for positioning, navigation, and obstacle avoidance.
[0047] The real-time, stable and continuous position, direction, speed and attitude information of the skid loader 9 is obtained through the inertial navigation 6, and transmitted to the autonomous driving domain controller 8 through the 5G industrial gateway 7;
[0048] The autonomous driving domain controller 8 collects the above information through the 5G industrial gateway 7, processes the data, formulates the whole machine operation strategy, and converts it into the whole machine operation signal to be transmitted to the electronic control operating system of the skid loader 9. The electronic control operating system can control the bucket 11 and boom 21 of the skid loader 9 to perform shoveling, collecting, lifting and unloading related operations, and can control the wheel drive units on both sides to control the skid loader 9 to move forward, backward or turn, etc., and can control the brake unit to control the skid loader 9 to stop, etc., ultimately realizing unmanned driving of the skid loader 9.
[0049] From the above content, it can be seen that the skid loader provided in this embodiment can realize automatic shoveling and automatic lifting and unloading of the skid loader, and can realize unmanned operation of the skid loader under high-risk and high-intensity conditions, which greatly ensures the safety and health of the operators and saves labor costs.
[0050] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.
Claims
1. A skid loader unmanned driving method, characterized in that: The loader includes: A first angle sensor (1), the first angle sensor (1) being arranged on the bucket (11) of the skid loader and being used for detecting the angle of the bucket (11) and sending a detected first angle signal to a controller; a second angle sensor (2), the second angle sensor (2) being arranged on the boom (21) of the skid loader and being used for detecting the angle of the boom (21) and sending a detected second angle signal to a controller; a controller, the controller controlling the movement of a bucket (11), a boom (21) and wheels of the skid loader according to the first angle signal and the second angle signal; The controller is an autonomous driving domain controller (8); The driverless method includes the following steps: Acquiring working status information of the bucket and boom of the skid loader through an angle sensor; Acquiring driving scene information of the skid loader through a camera; Acquiring information about objects around the skid loader through a laser radar; Acquiring the position, direction, speed and attitude information of the skid loader through inertial navigation; The above information is collected by the autonomous driving domain controller, data is processed, a whole machine operation strategy is formulated, and the whole machine operation strategy is converted into a whole machine operation signal and transmitted to the electronic control operating system of the skid loader, so as to realize unmanned driving of the skid loader; The first angle sensor (1) and the second angle sensor (2) have four groups of corresponding angle preset values: after the skid loader (9) moves to the stockpiling point, the first angle sensor (1) and the second angle sensor (2) first detect the angles of the bucket (11) and the boom (21); when the angles of the bucket (11) and the boom (21) reach the first group of preset values, the controller controls the wheels of the skid loader (9) to move forward to perform a shoveling operation; when the shoveling operation is completed, the controller controls the angles of the bucket (11) and the boom (21) to reach the second group of preset values to perform a shoveling operation. The skid loader (9) performs a collection operation, and then the skid loader (9) moves; when the skid loader (9) moves the material to the target position, the first angle sensor (1) and the second angle sensor (2) are used to detect the angles of the bucket (11) and the boom (21); when the angles of the bucket (11) and the boom (21) reach a third set of preset values, the controller controls the boom (21) of the skid loader (9) to lift and perform a lifting operation; after the lifting operation is completed, the angles of the bucket (11) and the boom (21) are controlled to reach a fourth set of preset values to perform a unloading operation.
2. The unmanned driving method of a skid loader according to claim 1, characterized in that: The skid loader is also provided with four cameras (3), which are respectively installed at four positions of the front, rear, left and right of the skid loader. The four cameras (3) respectively capture images of the skid loader in four directions of the front, rear, left and right, and transmit the images to the controller.
3. The unmanned driving method of a skid loader according to claim 2, characterized in that: The skid loader is also equipped with a blink controller (4), and the images captured by the four cameras (3) are processed by the blink controller (4) and a driving scene signal is sent to the controller.
4. The unmanned driving method of a skid loader according to claim 3, characterized in that: The skid loader is also provided with three laser radars (5), which are respectively installed at the left front, right front and middle rear positions of the top of the skid loader to perform 360-degree detection of surrounding object information of the skid loader and send radar detection signals to the controller.
5. The unmanned driving method of a skid loader according to claim 4, characterized in that: The skid loader is also equipped with an inertial navigation system (6), which detects the position, direction, speed and posture information of the skid loader in real time and sends an inertial navigation detection signal to the controller.
6. The unmanned driving method of a skid loader according to claim 5, characterized in that: The first angle signal, the second angle signal, the driving scene signal, the radar detection signal and the inertial navigation detection signal are sent to the autonomous driving domain controller (8) via the 5G industrial gateway (7).
