阅读说明：本技术 环卫车及其车身姿态检测方法、车身稳定方法及对应系统 (Sanitation vehicle, vehicle body posture detection method thereof, vehicle body stabilization method and corresponding system ) 是由 李群峰 赵玉东 张冬 李利锋 翟锋涛 张增 于 2018-07-23 设计创作，主要内容包括：本发明涉及环卫车及其车身姿态检测方法、车身稳定方法及对应系统,首先建立车身三维坐标系,其中,X轴的方向为车头朝向方向,Y轴的方向为与车头朝向方向相垂直的车身横向方向,Z轴的方向为垂直于车身底盘平面的方向；然后检测车身在X轴方向上的加速度、在Y轴方向上的加速度和在Z轴方向上的加速度,以及以X轴为转动轴的车身侧倾角度、以Y轴为转动轴的车身俯仰角度和以Z轴为转动轴的车身横摆角度；最后根据得到的各数据获取车身姿态,还能够根据车身姿态进行车身稳定。该姿态检测方式是自动检测方式,相较于人工凭借驾驶经验判断环卫车车身姿态的方式,可靠性得到很大的提升。(The invention relates to a sanitation vehicle, a vehicle body posture detection method, a vehicle body stabilizing method and a corresponding system thereof.A vehicle body three-dimensional coordinate system is established at first, wherein the direction of an X axis is the direction of the heading direction of a vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the heading direction of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body; then detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as a rotating shaft and the yaw angle of the vehicle body taking the Z-axis as a rotating shaft; and finally, acquiring the posture of the vehicle body according to the obtained data, and stabilizing the vehicle body according to the posture of the vehicle body. The posture detection mode is an automatic detection mode, and compared with a mode of manually judging the posture of the sanitation vehicle body through the driving experience, the reliability is greatly improved.)

1. The method for detecting the body posture of the sanitation vehicle is characterized by comprising the following steps of:

(1) establishing a three-dimensional coordinate system of the vehicle body, wherein the direction of an X axis is the direction of the heading of the vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the direction of the heading of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

(2) detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body using the X-axis as a rotating shaft, the pitch angle of the vehicle body using the Y-axis as a rotating shaft and the yaw angle of the vehicle body using the Z-axis as a rotating shaft;

(3) and acquiring the posture of the vehicle body according to the obtained data.

2. The sanitation vehicle body posture detecting method of claim 1, further comprising the following steps between the step (2) and the step (3): and filtering each detected data by adopting a Kalman filtering processing mode.

3. The utility model provides a sanitation car automobile body gesture detecting system which characterized in that includes:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

and the vehicle body posture acquisition module is used for acquiring the vehicle body posture according to the obtained data.

4. The sanitation vehicle body attitude detection system of claim 3, wherein the detection system further comprises a Kalman filtering module for filtering each data detected by the data detection module in a Kalman filtering processing manner.

5. The utility model provides a sanitation car which characterized in that, includes a sanitation car automobile body gesture detecting system, detecting system includes:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

and the vehicle body posture acquisition module is used for acquiring the vehicle body posture according to the obtained data.

6. A sanitation vehicle body stabilizing method is characterized by comprising the following steps:

(1) establishing a three-dimensional coordinate system of the vehicle body, wherein the direction of an X axis is the direction of the heading of the vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the direction of the heading of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

(2) detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body using the X-axis as a rotating shaft, the pitch angle of the vehicle body using the Y-axis as a rotating shaft and the yaw angle of the vehicle body using the Z-axis as a rotating shaft;

(3) acquiring the posture of the vehicle body according to the obtained data;

(4) and performing vehicle body stability control according to the obtained vehicle body posture.

7. A method for stabilizing a body of a sanitation vehicle as claimed in claim 6, wherein the following steps are further included between step (2) and step (3): and filtering each detected data by adopting a Kalman filtering processing mode.

8. A sanitation vehicle body stabilizing system, comprising:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

the vehicle body posture acquisition module is used for acquiring vehicle body postures according to the obtained data;

and the vehicle body stabilizing module is used for performing vehicle body stability control according to the obtained vehicle body posture.

9. The sanitation vehicle body stabilizing system of claim 8, further comprising a kalman filter module, configured to filter each data detected by the data detection module by using a kalman filter processing method.

10. A sanitation vehicle comprising a sanitation vehicle body stabilizing system, the body stabilizing system comprising:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

the vehicle body posture acquisition module is used for acquiring vehicle body postures according to the obtained data;

and the vehicle body stabilizing module is used for performing vehicle body stability control according to the obtained vehicle body posture.

Technical Field

The invention relates to a sanitation vehicle, a vehicle body posture detection method thereof, a vehicle body stabilizing method and a corresponding system.

Background

The sanitation vehicle is a special vehicle for cleaning the road surface. Because of the operating characteristics of sanitation car, sanitation car is in the course of the work, sometimes road environment is comparatively harsh, for example: the road may have a protruding foreign object or a ditch with unknown depth, and the sanitation vehicle may have an uphill slope or a downhill slope with a relatively steep gradient on the working road. When the sanitation vehicle passes through the above severe road surface, the vehicle body can shake to a certain degree, and even more, the vehicle can turn over. Therefore, the sanitation vehicle needs a vehicle body posture judgment strategy or a vehicle body stability control strategy to acquire the vehicle body posture in real time and stabilize the vehicle body according to the vehicle body posture. However, the existing sanitation vehicle body posture judgment strategy or vehicle body stability control strategy is a manual judgment mode, and a driver manually judges the vehicle body posture or the vehicle body stability condition according to the driving experience, and the reliability of the manual judgment mode is lower.

Disclosure of Invention

The invention aims to provide a sanitation vehicle and a vehicle body posture detection method and system thereof, which are used for solving the problem of poor reliability of a mode of manually judging the vehicle body posture of the sanitation vehicle through driving experience. The invention also provides the sanitation vehicle and a vehicle body stabilizing method and system thereof, which are used for solving the problem of poor reliability of the conventional sanitation vehicle body stabilizing mode.

In order to achieve the above object, the present invention includes the following technical solutions.

A sanitation vehicle body posture detection method comprises the following steps:

(1) establishing a three-dimensional coordinate system of the vehicle body, wherein the direction of an X axis is the direction of the heading of the vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the direction of the heading of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

(2) detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body using the X-axis as a rotating shaft, the pitch angle of the vehicle body using the Y-axis as a rotating shaft and the yaw angle of the vehicle body using the Z-axis as a rotating shaft;

(3) and acquiring the posture of the vehicle body according to the obtained data.

Firstly, a three-dimensional coordinate system of the vehicle body is established, then the acceleration of the vehicle body in the direction of each axis and the vehicle body angle related to each axis are detected according to the established coordinate system, and finally the vehicle body posture is obtained according to the obtained data. Generally, since the vehicle body posture is embodied by the acceleration and angle data corresponding to the three axes in the three-dimensional coordinate system, the vehicle body posture can be accurately obtained by detecting the data information of the three axes from the obtained three-dimensional coordinate system, and therefore, the vehicle body posture detection accuracy is greatly improved. Moreover, the detection mode is an automatic detection mode, compared with a mode that the posture of the sanitation vehicle body is judged manually through the driving experience, the reliability is greatly improved, and the detection result has no hysteresis.

Further, the following steps are also included between the step (2) and the step (3): and filtering each detected data by adopting a Kalman filtering processing mode.

A sanitation vehicle body attitude detection system, comprising:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

and the vehicle body posture acquisition module is used for acquiring the vehicle body posture according to the obtained data.

Furthermore, the detection system further comprises a kalman filtering module, which is used for filtering each data detected by the data detection module by using a kalman filtering processing mode.

A sanitation vehicle including a sanitation vehicle body attitude detection system, the detection system comprising:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

and the vehicle body posture acquisition module is used for acquiring the vehicle body posture according to the obtained data.

A sanitation vehicle body stabilizing method comprises the following steps:

(1) establishing a three-dimensional coordinate system of the vehicle body, wherein the direction of an X axis is the direction of the heading of the vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the direction of the heading of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

(2) detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body using the X-axis as a rotating shaft, the pitch angle of the vehicle body using the Y-axis as a rotating shaft and the yaw angle of the vehicle body using the Z-axis as a rotating shaft;

(3) acquiring the posture of the vehicle body according to the obtained data;

(4) and performing vehicle body stability control according to the obtained vehicle body posture.

Firstly, a three-dimensional coordinate system of the vehicle body is established, then the acceleration of the vehicle body in the direction of each axis and the vehicle body angle related to each axis are detected according to the established coordinate system, then the vehicle body posture is obtained according to the obtained data, and finally the vehicle body stability control is carried out according to the vehicle body posture. Generally, the vehicle body posture is embodied in the acceleration and angle data corresponding to three axes in the three-dimensional coordinate system, and therefore, the vehicle body posture can be accurately obtained by detecting the data information of the three axes according to the obtained three-dimensional coordinate system, so that the vehicle body posture detection precision is greatly improved, and the reliability of vehicle body stability control is further improved.

Further, the following steps are also included between the step (2) and the step (3): and filtering each detected data by adopting a Kalman filtering processing mode.

A sanitation vehicle body stabilization system, comprising:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

the vehicle body posture acquisition module is used for acquiring vehicle body postures according to the obtained data;

and the vehicle body stabilizing module is used for performing vehicle body stability control according to the obtained vehicle body posture.

Further, the vehicle body stabilization system further comprises a Kalman filtering module, and the Kalman filtering module is used for filtering each data detected by the data detection module in a Kalman filtering processing mode.

A sanitation vehicle including a sanitation vehicle body stability system, the body stability system comprising:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

the vehicle body posture acquisition module is used for acquiring vehicle body postures according to the obtained data;

and the vehicle body stabilizing module is used for performing vehicle body stability control according to the obtained vehicle body posture.

Drawings

FIG. 1 is a schematic three-dimensional coordinate system of an aircraft fuselage;

FIG. 2 is a schematic view of a three-dimensional coordinate system of a vehicle body;

fig. 3 is a schematic view of a vehicle body stability control process.

Detailed Description

Sanitation vehicle embodiment one

The embodiment provides a sanitation car, for example new forms of energy sanitation car. The sanitation vehicle comprises a sanitation vehicle body posture detection system and other components which are not the protection key points of the sanitation vehicle and are not described in detail herein.

The detection system includes:

the vehicle body three-dimensional coordinate system establishing module is used for establishing a vehicle body three-dimensional coordinate system, wherein the direction of an X axis is the direction of the head, the direction of a Y axis is the transverse direction of a vehicle body which is vertical to the direction of the head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

the data detection module is used for detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and detecting the roll angle of the vehicle body taking the X-axis as a rotating shaft, the pitch angle of the vehicle body taking the Y-axis as the rotating shaft and the yaw angle of the vehicle body taking the Z-axis as the rotating shaft;

and the vehicle body posture acquisition module is used for acquiring the vehicle body posture according to the obtained data.

Therefore, in the detection system, the corresponding components are defined by the functional roles of the components, and therefore, the detection system corresponds to a sanitation vehicle body posture detection method comprising the following steps:

(1) establishing a three-dimensional coordinate system of the vehicle body, wherein the direction of an X axis is the direction of the heading of the vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the direction of the heading of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

(2) detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body using the X-axis as a rotating shaft, the pitch angle of the vehicle body using the Y-axis as a rotating shaft and the yaw angle of the vehicle body using the Z-axis as a rotating shaft;

(3) and acquiring the posture of the vehicle body according to the obtained data.

A specific embodiment is provided below to describe the above sanitation vehicle body posture detecting system, i.e., the sanitation vehicle body posture detecting method.

And establishing a vehicle body three-dimensional coordinate system by referring to the airplane body three-dimensional coordinate system, wherein the fig. 1 is the airplane body three-dimensional coordinate system. As shown in fig. 2, the three-dimensional coordinate system of the vehicle body includes an X axis, a Y axis and a Z axis, wherein the direction of the X axis is the direction of the vehicle head, and then the X axis is called a roll axis X (roll); the direction of the Y axis is a transverse direction of the vehicle body (i.e. a direction perpendicular to the direction of the vehicle head), which is perpendicular to the direction of the vehicle head, and the Y axis is called a pitch axis Y (pitch); the direction of the Z-axis is perpendicular to the plane of the chassis of the vehicle body, and the Z-axis is referred to as the yaw axis Z (YAW).

In this embodiment, the data detection module for detecting the related data is, for example, a 6-axis gyroscope, such as an MPU60X0 series 6-axis gyroscope. The 6-axis gyroscope is not only implemented in one way, but has three ways of construction, which are: 6-axis gyroscopes, 9-axis gyroscopes, 3-axis accelerometers + 3-axis gyroscopes. Of course, the data can be realized by butting a single accelerometer and a single gyroscope, or by a 9-axis integrated gyroscope, but considering that the vehicle body is full of metal and high-low voltage circuits, 3-axis magnetic field data in the 9-axis gyroscope cannot play a role, and the detected data is inaccurate, so that the optimal scheme is to adopt the integrated 6-axis gyroscope.

Thus, the function of a 6-axis gyroscope is: the acceleration Gx of the vehicle body in the X-axis direction, the acceleration Gy in the Y-axis direction, and the acceleration Gz in the Z-axis direction are detected, as well as the vehicle body roll angle (i.e., roll angle) with the X-axis as the rotation axis, the vehicle body pitch angle (i.e., pitch angle) with the Y-axis as the rotation axis, and the vehicle body yaw angle (i.e., yaw angle yaw) with the Z-axis as the rotation axis, as shown in fig. 2. The pitch angle pitch indicates the posture of the vehicle body in an ascending or descending slope and the angle of the slope in real time, the dynamic response time is less than 10ms, and the vehicle body can be judged to be in the ascending or descending slope by matching with the acceleration Gx; the roll angle roll indicates the roll angle, left or right inclination and the inclination angle of the vehicle body in real time; the yaw angle yaw reflects the magnitude of the vehicle body turning.

In this embodiment, the vehicle body posture acquiring module that detects the vehicle body posture according to the detection data of the 6-axis gyroscope is specifically a vehicle control unit, that is, the vehicle control unit is configured to acquire the vehicle body posture. Then, a data interface of a 6-axis gyroscope is added on the vehicle controller, the 6-axis gyroscope integrates a 3-axis accelerometer and a 3-axis gyroscope, and the data interface is in butt joint with a related data interface on the vehicle controller through an IIC or SPI interface to receive detection data of the 6-axis gyroscope. Therefore, the 6-axis gyroscope not only can provide the inclined posture of the vehicle body, but also can provide the acceleration value of the acceleration and the deceleration of the vehicle body, and the vehicle control unit can carry out vehicle dynamic judgment, particularly in the aspects of brake intervention and rapid acceleration.

Further, filtering detection data of the 6-axis gyroscope, specifically, performing smooth filtering on each detected data in a Kalman filtering processing mode to ensure that the acquired data truly and reliably reflect the state of the vehicle body, and then outputting the data after filtering processing to the vehicle control unit. The data after Kalman filtering, including roll angle roll, pitch angle pitch, yaw angle yaw and acceleration values of all axes, are commonly used for assisting in making a control strategy decision of the whole vehicle.

Therefore, the roll angle roll, the pitch angle pitch, the yaw angle yaw and the acceleration values of all the axes can fully reflect the environment of the vehicle body and the running state of the vehicle body, including linear acceleration, backward movement, turning and the like, and the vehicle controller analyzes the roll angle roll, the pitch angle pitch, the yaw angle yaw and the acceleration values of all the axes detected by the 6-axis gyroscope to obtain the posture of the vehicle body. And after the vehicle body posture is obtained, the vehicle control unit makes a vehicle control strategy decision by combining the data and signals of an accelerator pedal and a brake pedal, so that the stability of the vehicle body is ensured. As shown in fig. 3, a vehicle control strategy is completed by using a 6-axis gyroscope in cooperation with a vehicle controller and a motor controller.

Therefore, the environmental sanitation vehicle is assisted by the gyroscope, the judgment of the vehicle body posture does not have hysteresis, the fluency of a gear shifting strategy is improved, and the phenomenon that the whole vehicle is subjected to pause and frustration is avoided; also, there is no hysteresis in the detection in terms of the roll of the vehicle body. And the sanitation vehicle realizes an auxiliary vehicle control strategy according to the 6-axis gyroscope, detects the vehicle posture in real time, ensures that the vehicle controller is involved in time, and ensures the stability of the vehicle body through active control. The vehicle cost is not additionally increased, data acquisition of a 6-axis gyroscope is added on the conventional vehicle controller, optimized Kalman filtering processing is performed according to real-time data by using a four-axis unmanned aerial vehicle flight control filtering algorithm for reference, and the vehicle power output is controlled by cooperating with a vehicle control strategy, so that the vehicle controller is particularly suitable for four-wheel drive vehicles.

The specific embodiments are given above, but the present invention is not limited to the described embodiments. The basic idea of the present invention lies in the above basic scheme, and it is obvious to those skilled in the art that no creative effort is needed to design various modified models, formulas and parameters according to the teaching of the present invention. Variations, modifications, substitutions and alterations may be made to the embodiments without departing from the principles and spirit of the invention, and still fall within the scope of the invention.

Embodiment of sanitation vehicle body posture detection system

The embodiment provides a body posture detection system of a sanitation vehicle, and since the detection system is described in detail in the first embodiment of the sanitation vehicle, the detailed description is omitted here.

Embodiment of method for detecting body posture of sanitation vehicle

The embodiment provides a method for detecting the body posture of a sanitation vehicle, which comprises the following steps:

(1) establishing a three-dimensional coordinate system of the vehicle body, wherein the direction of an X axis is the direction of the heading of the vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the direction of the heading of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

(2) detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body using the X-axis as a rotating shaft, the pitch angle of the vehicle body using the Y-axis as a rotating shaft and the yaw angle of the vehicle body using the Z-axis as a rotating shaft;

(3) and acquiring the posture of the vehicle body according to the obtained data.

Since the implementation process of the detection method is described in detail in the first embodiment of the sanitation truck, it is not specifically described here.

Sanitation vehicle embodiment II

The sanitation car that this embodiment provided includes sanitation car body stable system, and this body stable system still includes the automobile body stabilizing module for carry out automobile body stability control according to the automobile body gesture that obtains in the sanitation car automobile body attitude detecting system that compares in sanitation car embodiment one. Therefore, the sanitation vehicle provided by the embodiment is additionally provided with the vehicle body stabilizing module on the basis of the sanitation vehicle embodiment I. Because the implementation process of the vehicle body stability control according to the vehicle body posture belongs to the prior art, the following concrete strategies are provided for the vehicle body stability control:

when the sudden change of the yaw angle yaw value of the vehicle body is detected, for example, the sudden increase (the sudden increase means that the increase change rate of the yaw angle yaw value is greater than the set value), the torque output can be reduced, and the rollover caused by high-speed over-bending can be prevented; aiming at the four-wheel drive system, the torque of the outer side wheel can be limited, and the vehicle body can be adjusted to be stable;

when detecting that the roll value of the body roll angle changes, the larger the roll value is, the smaller the output torque is, and the rollover under the roll condition is prevented; aiming at the four-wheel drive system, the torque of the lower wheel can be increased, or the torque of the upper wheel can be reduced, and the vehicle body can be adjusted to be stable;

when the pitching angle pitch of the vehicle body is detected, the vehicle body is judged to be an ascending slope or a descending slope by combining the positive and negative values of the acceleration Gx, so that a power control strategy for increasing the torque or reducing the torque is made, wherein the torque output is increased when the vehicle body ascends the slope, and the torque output is reduced when the vehicle body descends the slope.

Sanitation vehicle body stabilizing system embodiment

This embodiment provides a body stabilizing system for a sanitation vehicle, which is not described in detail herein since it is described in detail in the second embodiment of the sanitation vehicle.

Embodiment of method for stabilizing sanitation vehicle body

The embodiment provides a sanitation vehicle body stabilizing method, which comprises the following steps:

(1) establishing a three-dimensional coordinate system of the vehicle body, wherein the direction of an X axis is the direction of the heading of the vehicle head, the direction of a Y axis is the transverse direction of the vehicle body which is vertical to the direction of the heading of the vehicle head, and the direction of a Z axis is the direction vertical to the plane of a chassis of the vehicle body;

(2) detecting the acceleration of the vehicle body in the X-axis direction, the acceleration in the Y-axis direction and the acceleration in the Z-axis direction, and the roll angle of the vehicle body using the X-axis as a rotating shaft, the pitch angle of the vehicle body using the Y-axis as a rotating shaft and the yaw angle of the vehicle body using the Z-axis as a rotating shaft;

(3) acquiring the posture of the vehicle body according to the obtained data;

(4) and performing vehicle body stability control according to the obtained vehicle body posture.

Since the implementation process of the vehicle body stabilizing method is described in detail in the second embodiment of the sanitation vehicle, it will not be described in detail here.