[go: up one dir, main page]

CN109916362A - Method and system for detecting rotation angle of steering wheel - Google Patents

Method and system for detecting rotation angle of steering wheel Download PDF

Info

Publication number
CN109916362A
CN109916362A CN201910160489.1A CN201910160489A CN109916362A CN 109916362 A CN109916362 A CN 109916362A CN 201910160489 A CN201910160489 A CN 201910160489A CN 109916362 A CN109916362 A CN 109916362A
Authority
CN
China
Prior art keywords
steering wheel
data
axis
gravitational acceleration
chip microcomputer
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.)
Granted
Application number
CN201910160489.1A
Other languages
Chinese (zh)
Other versions
CN109916362B (en
Inventor
张洪昌
赵伟
郭军
密兴林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan University of Technology WUT
Original Assignee
Wuhan University of Technology WUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Wuhan University of Technology WUT filed Critical Wuhan University of Technology WUT
Priority to CN201910160489.1A priority Critical patent/CN109916362B/en
Publication of CN109916362A publication Critical patent/CN109916362A/en
Application granted granted Critical
Publication of CN109916362B publication Critical patent/CN109916362B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Steering Controls (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明公开了一种方向盘转动角度的检测方法及系统,该系统包括两个单元,其中第一单元设有第一单片机和通过数据线与之相连的第一重力加速度传感器、第一蓝牙模块、串口通讯模块、他取电电源模块;第二单元设有第二单片机和通过数据线与之相连的第二重力加速度传感器、第三重力加速度传感器、第二蓝牙模块、自供电电源模块。该方法包括系统初始化、数学关系式的建立、输出数据等步骤。本发明具有结构简单、易于安装,测试方法清晰明了,对驾驶员的操作要求较低等优点。

The invention discloses a method and system for detecting the rotation angle of a steering wheel. The system includes two units, wherein the first unit is provided with a first single-chip microcomputer, a first gravitational acceleration sensor, a first Bluetooth module, The serial communication module and the other power supply module; the second unit is provided with a second single-chip microcomputer, a second gravitational acceleration sensor, a third gravitational acceleration sensor, a second bluetooth module, and a self-powered power supply module connected to it through a data cable. The method includes the steps of system initialization, establishment of mathematical relationship, output data and the like. The invention has the advantages of simple structure, easy installation, clear testing method, and lower requirements for the driver's operation.

Description

A kind of detection method and system of steering wheel rotational angle
Technical field
The present invention relates to driver's driving behavior field of information acquisition more particularly to a kind of detections of steering wheel rotational angle Method and system.
Background technique
With the development of national economy, vehicle population just increases year by year, and traffic occurs in order to guarantee driving safety, reduce Accident, the infomation detection and related experiment of vehicle just more seem important.Turn at present in many vehicle drive safe early warnings, wheel Into equal detection schemes and experiment, the steering wheel angle data of acquisition vehicle are required, microcomputer obtains steering wheel angle Comprehensive other information is by analyzing and determining driving condition after data.However, many vehicles are not equipped with steering wheel angle at present Detection sensor also can not just detect steering wheel angle data;Even if some middle and high end cars equipped with the sensor, but The interfaces such as OBD do not provide steering wheel angle data generally;Even if OBD interface provides steering wheel angle data, communications protocol Be it is extremely complex, it is highly difficult therefrom effectively to read out steering wheel angle data;If installing vehicular steering wheel angle sensor additional, Then with high costs and installation is inconvenient, and can influence very much to drive sense after the installation of the steering wheel angle sensor of non-vehicle-mounted type By.A kind of<the side of<method and device for detecting steering wheel for vehicle corner>>(application publication number: 107585210 A of CN) invention To disk angle detection method and device, using vehicle intelligent terminal MCU and its included 3D acceleration transducer, by adopting in real time Collect the parameters such as vehicle acceleration and speed, calculate wheel steering angle, and detects steering wheel for vehicle corner indirectly, measurement method fiber crops Tired, installation is complicated.Therefore, the invention proposes the detection methods and system of a kind of steering wheel rotational angle.
Summary of the invention
The technical problem to be solved in the invention is: the detection method and system of a kind of steering wheel rotational angle are provided, with Just the difficult to install, size for solving existing steering wheel angle acquisition system is big, influences to drive after installation, at high cost, accuracy rate Low defect.
The present invention solves its technical problem, and the following technical solution is employed:
The detection system of steering wheel rotational angle provided by the invention comprising two units, in which: first unit is equipped with First singlechip and the first gravity accelerometer being attached thereto by data line, the first bluetooth module, serial communication mould Block, he take power supply module;The second acceleration of gravity that second unit is equipped with second singlechip and is attached thereto by data line Sensor, third gravity accelerometer, the second bluetooth module, self powered supply module.
It is described he to take electricity be a kind of title corresponding with self-powered, mean and electricity obtained by other devices or equipment Source.
The first unit provides electric energy by vehicle power supply on vehicle body;First gravity accelerometer is mounted in On steering wheel hub axis at the steering wheel, establish using vehicle direction of advance as positive direction of the x-axis, with vertical vehicle body be downwards z-axis just Direction and the y-axis rectangular coordinate system in space A that meets right-hand rule in vertical vehicle body plane orthogonal with z-axis.
On the steering wheel, by providing electric energy from the power module of charged pool, the second gravity accelerates the second unit dress Degree sensor mounted in steering wheel do not rotate when steering wheel hub axis top, establish with steering wheel hub axis be inwardly z-axis positive direction, With vertical direction disk axis be positive direction of the x-axis forward and y-axis is orthogonal with x-axis meets right-hand rule in steering wheel plane Rectangular coordinate system in space B1;Third gravity accelerometer and the second gravity accelerometer are orthogonal mounted in direction Steering wheel hub axis left part when disk does not rotate, establish with steering wheel axis be inwardly z-axis positive direction, with vertical direction disk axis just It is upwards positive direction of the y-axis and the x-axis rectangular coordinate system in space for meeting right-hand rule in steering wheel plane orthogonal with y-axis B2;The origin of rectangular coordinate system in space B1, B2 are overlapped with two gravity accelerometers, and as two acceleration of gravity pass Sensor and steering wheel connect firmly rotation.
The acceleration of gravity and acceleration of motion of three gravity accelerometers detection vehicle are each in its sensor Component values on a axis, second singlechip read and handle the detection data of second and third gravity accelerometer, the One single-chip microcontroller is read and the reception data of the detection data of the first gravity accelerometer of processing and the first bluetooth module, calculates Steering wheel rotational angle out, by serial communication module output data, first singlechip and the second bluetooth module carry out data and lead to News.
The largest interval time of the gravity accelerometer detection data is 2 milliseconds, and single-chip microcontroller reads gravity and adds The time interval of velocity sensor detection data is freely set 10 milliseconds to 200 milliseconds by user, and single-chip microcontroller presses user The time interval of setting obtains the detection data of gravity accelerometer.
The detection method of steering wheel rotational angle provided by the invention, comprising the following steps:
Step1, system initialization establish rectangular coordinate system in space A, B1, B2, C;Second singlechip passes through the second bluetooth mould Block sends data synchronization time, single-chip microcontroller energy after the detection data for receiving three gravity accelerometers to first singlechip It is enough to carry out processing data by the same time;
Step2, when vehicle remains static, the first gravity accelerometer detects to obtain acceleration of gravity in sky Between numerical value in rectangular coordinate system A on z-axis direction be a1z, decomposed by parallelogram law, obtain relationship a1z =gcos θ, is calculated the angle theta between vehicle and level road, i.e. road gradient;
Step3, when vehicle remains static, pilot control steering wheel clockwise slowly turns around by rotation, when another mistake Needle, which slowly revolves, to turn around, second and third gravity accelerometer detect vehicle acceleration, when the second acceleration of gravity sense Device detects numerical value maximum point in its x-axis, when third gravity accelerometer detects numerical value maximum point in its y-axis, it is specified that The position is the initial position S of steering wheel, second and third gravity accelerometer where point be respectively origin o, o';
Step4, when the vehicle is running, vehicle generates total accelerationFirst, second, and third acceleration of gravity sensing Device detects the acceleration of each axis;
Step5, second singlechip obtain the data of second and the detection of third gravity accelerometer, carry out at data Acceleration information and time data are sent to first singlechip by the second bluetooth module by reason, and first singlechip passes through first Bluetooth module receives data, and first singlechip receives the data of the first gravity accelerometer transmission simultaneously;
Temporally data handle the detection data of synchronization for Step6, first singlechip, when steering wheel is located at just When beginning position S, by vehicle accelerationDecompose on each axis of rectangular coordinate system in space C, set on each axis at this time numerical value as acx、acy、acz.When one angle γ of pilot control direction disc spins, second and third gravity accelerometer can be in its x Detect that acceleration value is a on axis2x'、a3x', detect that acceleration value is a on the y axis2y'、a3y', it is detected in z-axis Acceleration value is a2z'、a3z', at this time second and what third gravity accelerometer detected is that vehicle entirety acceleration exists Rectangular coordinate system in space B1, B2 each axis is decomposed after numerical value, can solve steering wheel rotation angle γ11、γ12, public Formula are as follows:
Then wheel steering angle γ1Calculation formula are as follows:
It, can the side of solving by the data that third gravity accelerometer measures on the basis of rectangular coordinate system in space C To disc spins angle γ21、γ22, formula are as follows:
Then wheel steering angle γ2Calculation formula are as follows:
Therefore the calculation formula of wheel steering angle γ are as follows:
After Step7, first singlechip calculate steering wheel angle, data are filtered, are turned by JC communications protocol Pass through serial communication module output data after being melted into serial data.
In the above method, first singlechip is filtered steering wheel angle data, mode is filtered are as follows: first Single-chip microcontroller arbitrarily obtains the steering wheel rotational angle data at continuous five moment and stores, and carries out curve fitting, by curvilinear motion Trend prediction subsequent time steering wheel angle data, and the steering wheel angle data of the curve matching at this moment are exported.
In the above method, JC communications protocol regulation: all data are converted into ASCII transmission, and each data packet includes 25 Data/character, the 1st, 2 is data packet head " JC ";3rd to 11 for when meta position, format be "+two minutes of two hourages + two+three millisecond numbers of bps clock number of number ";12nd to 13 is direction position, and format is "+one number of full circle in direction of rotation position Position ", direction of rotation position regulation are counterclockwise 0, are clockwise 1;14th to 18 is current steering wheel angle of rotation degree, and format is " three whole degree+decimals of decimal point+one ";19th to 20 bit check position, verification rule are the data conversion of front the 1st to 18 To sum after hexadecimal, sum number is taken to remove 256 remainder;21st to 25 is estimated steering wheel angle of rotation degree, and format is " three Whole degree+the decimal of decimal point+one in position ".
The present invention has following major advantage compared with prior art:
(1) size is smaller, and structure is simple, is easily installed, and will not produce bigger effect to the driving experience of driver;
(2) time interval that single-chip microcontroller D1 obtains data can be able to satisfy different user to acquisition number by user's sets itself According to time requirement, universality is strong, time interval be 20ms when can meet racing wheels outer corner measurement, time interval is Meet general user's urban road wheels outer corner measurement when 100ms~200ms, time interval can meet when being 500ms Steering wheel angle of driving at low speed measurement;
(3) test method is clear, requires the operation of driver lower, will not generate to the driving of driver dry It disturbs;
(4) output data is filtered, and has carried out effective fitting, reduced the error of DATA REASONING, mention The high precision of steering wheel angle DATA REASONING, error is measured after off-line secondary processing and is missed less than 10% when On-line sampling system Difference is less than 5.4%;
(5) when the time interval that single-chip microcontroller D1 obtains data is less than 200ms, subsequent time steering wheel angle predicts that error is small In 12%.
(6) steering wheel angle data are exported in the form of serial data, and communications protocol is simple, are convenient for user's reading process number According to.
Detailed description of the invention
Fig. 1 is a kind of detection method of steering wheel rotational angle of the embodiment of the present invention and the general structure schematic diagram of system.
Fig. 2 is the enlarged diagram of steering wheel 2 and second unit 3 in Fig. 1.
Fig. 3 is a kind of detection method of steering wheel rotational angle of the embodiment of the present invention and the space right-angle of system established Coordinate system B1, B2, C.
Fig. 4 is the enlarged diagram of steering wheel 2 and second unit 3 in Fig. 3.
Fig. 5 is the structure group of a kind of detection method of steering wheel rotational angle of the embodiment of the present invention and the first unit of system At schematic diagram.
Fig. 6 is the circuit original of a kind of detection method of steering wheel rotational angle of the embodiment of the present invention and the first unit of system Reason figure.
Fig. 7 is the structure group of a kind of detection method of steering wheel rotational angle of the embodiment of the present invention and the second unit of system At schematic diagram.
Fig. 8 is the circuit original of a kind of detection method of steering wheel rotational angle of the embodiment of the present invention and the second unit of system Reason figure.
In figure: 1. steering wheel hub axis, 2. steering wheels, 3. second units, 4. first units, 5. vehicle bodies, 6. gravity accelerate Spend sensor J1,7. gravity accelerometer J2,8. gravity accelerometer J3.
Specific embodiment
The present invention relates to the detection methods and system of a kind of steering wheel rotational angle.Be designed to provide it is a kind of it is novel, The detection method and system for the steering wheel rotational angle that size is small and accuracy is high.The step of realizing steering wheel angle Data Detection It is: two units of installation, realization system initialization, gravity accelerometer real-time detection component of acceleration, single-chip microcontroller reading, It is exported after processing data.The present invention can reduce the size of steering wheel angle sensor, improve the accuracy of measurement, operation letter It is single, it can be based on user demand sets itself data collection cycle, universality is strong.
Below with reference to examples and drawings, the invention will be further described, but does not limit the present invention.
A kind of detection system of steering wheel rotational angle provided by the invention, as Figure 1-Figure 4, including first unit 4 With second unit 3.First unit is as shown in figure 5, including single-chip microcontroller D1 and the J1 (acceleration of gravity being attached thereto by data line Sensor 6), bluetooth module L1, serial communication module, be additionally provided with him and take power supply module C1.Second unit is as shown in fig. 7, packet Include the single-chip microcontroller D2 and J2 being attached thereto by data line (gravity accelerometer 7), J3 (gravity accelerometer 8), Bluetooth module L2 is additionally provided with self powered supply module C2.
It is the serial TTL of TTL that the gravity accelerometer, which selects model GY-291, power supply 5v, communication mode, The gravity accelerometer of communication protocol 3, component of the acceleration total for real-time detection vehicle on each axis.
The single-chip microcontroller selects model C 8052F580DK, power supply is 5v single-chip microcontroller 2, single-chip microcontroller D1 is for reading The detection data of gravity accelerometer J1 and the reception data of bluetooth module L1 are taken and handled, steering wheel angle of rotation is calculated Degree, by serial communication module output data, single-chip microcontroller D2 is for reading and handling gravity accelerometer J2, gravity acceleration Spend the detection data of sensor J3.
The bluetooth module selects model HC-06, power supply is 5v bluetooth module 2, for sending and receiving The processing data of single-chip microcontroller.
The serial communication module selects model TELESKY, uses CP2102 core chip, power supply for the string of 5v Mouth communication module sends serial data for single-chip microcontroller D1.
The power module C1 directly takes electricity from vehicle power supply, and power module C2 selection model LRS-50-24, voltage are The power module of 5v, for powering for second unit.
The physical circuit of above-mentioned first unit is as shown in fig. 6, include four parts, in which: gravity accelerometer J1 2 ends, 3 ends be connected with the port P0.4, P0.5 of single-chip microcontroller D1,1 port of gravity accelerometer J1 connects power positive end, 4 ports of gravity accelerometer J1 are grounded.The port P1.3, P1.2 phase at 2 ends of bluetooth module L1,3 ends and single-chip microcontroller D1 Even, 1 port of bluetooth module L1 connects power positive end, the 4 ports ground connection of bluetooth module L1.2 ends, 3 ends of serial communication module It is connected with the port P1.7, P1.6 of single-chip microcontroller D1,1 port of serial communication module connects power positive end, and the 4 of serial communication module Port ground connection.The VCC termination power positive terminal of single-chip microcontroller D1, the end GND ground connection.1,2 ports of power module C1 connect vehicle power supply, The positive terminal port of power module C1 connects the end each sensor 5V.
The physical circuit of above-mentioned second unit is as shown in figure 8, include five parts, in which: gravity accelerometer J2 2 ends, 3 ends be connected with the port P0.4, P0.5 of single-chip microcontroller D1,1 port of gravity accelerometer J2 connects power positive end, 4 ports of gravity accelerometer J2 are grounded;2 ends of gravity accelerometer J3,3 ends and single-chip microcontroller D1 P1.3, The port P1.2 is connected, and 1 port of gravity accelerometer J3 connects power positive end, 4 ports of gravity accelerometer J3 Ground connection.2 ends, 3 ends of bluetooth module L1 are connected with the port P1.7, P1.6 of single-chip microcontroller D1, and 1 port of bluetooth module L2 connects power supply Positive terminal, the 4 ports ground connection of bluetooth module L2.The VCC termination power positive terminal of single-chip microcontroller D2, the end GND ground connection.Power module C2 2 ports connect anode, 1 port of power module C2 connects power cathode.
A kind of detection system of steering wheel rotational angle provided by the invention, the course of work are as follows:
(1) first unit is connected firmly the parallel vehicle body 5 near steering wheel 2 to install, second unit is fixed on direction with plastic cement On disk 2.After installing two units, the initialization of system is carried out, realizes that the clock of two single-chip microcontrollers is synchronous, establishes corresponding sit Mark system, pilot control steering wheel determine initial position:
(2) component of the total acceleration on each axis of gravity accelerometer detection vehicle, and by the data of acquisition Send single-chip microcontroller D1, D2 to;
(3) single-chip microcontroller D2 reads the detection data of gravity accelerometer J2, J3, is passed after processing by blue-tooth device L2 Single-chip microcontroller D1 is given,;Single-chip microcontroller D1 reads the data of single-chip microcontroller D2 and gravity accelerometer J1, is filtered place to data After reason, conveyed with serial port form.
A kind of detection method of steering wheel rotational angle provided by the invention, specifically:
Two units are installed first, realize the initialization of system, and establish corresponding rectangular coordinate system in space.
1., single-chip microcontroller D2 by bluetooth module L2 to single-chip microcontroller D1 send data synchronization time, single-chip microcontroller D1, D2 are being received After the detection data of gravity accelerometer J1, J2, J3 processing data can be carried out by the same time;
2., as shown in Fig. 3-4 and Fig. 6, first unit connects firmly the parallel vehicle body near steering wheel and is mounted on vehicle body, by vehicle It carries power supply and electric energy is provided;Gravity accelerometer J1 is mounted on steering wheel hub axis 1 at steering wheel, is established with Chinese herbaceous peony It is positive direction of the x-axis, is downwards z-axis positive direction and y-axis meeting in vertical vehicle body plane orthogonal with z-axis with vertical vehicle body into direction The rectangular coordinate system in space A of right-hand rule;
3., as shown in Figure 5, Figure 7, second unit with plastic cement be fixedly mounted on the steering wheel, power module C2 provide electric energy, Gravity accelerometer J2 is mounted on steering wheel hub axis top when steering wheel does not rotate, establishes inside with steering wheel hub axis It is forward positive direction of the x-axis and y-axis meeting in steering wheel plane orthogonal with x-axis for z-axis positive direction, with vertical direction disk axis The rectangular coordinate system in space B1 of right-hand rule;Gravity accelerometer J3 and gravity accelerometer J2 are orthogonal It is mounted on steering wheel hub axis left part when steering wheel does not rotate, establishing with steering wheel axis is inwardly z-axis positive direction, with Vertical Square It is forward positive direction of the y-axis to disk axis and the x-axis space for meeting right-hand rule in steering wheel plane orthogonal with y-axis is straight Angular coordinate system B2;The origin of rectangular coordinate system in space B1, B2 are overlapped with acceleration transducer J2, J3 and with acceleration transducers J2, J3 and steering wheel connect firmly rotation;
4., establish with steering wheel axis be inwardly z-axis positive direction, with vertical direction disk axis forward for positive direction of the x-axis And the y-axis rectangular coordinate system in space C that meets right-hand rule, rectangular coordinate system in space C in steering wheel plane orthogonal with x-axis It does not rotate, the basis of reference as rectangular coordinate system in space B1, B2;Rectangular coordinate system in space C is equivalent to rectangular coordinate system in space A Steering wheel plane and vehicle body transverse direction angle α (0 90 ° of < α <) are rotated (in terms of from positive direction of the y-axis to negative direction) counterclockwise around y-axis.
Further, when vehicle remains static, gravity accelerometer J1, which detects to obtain acceleration of gravity, to exist Numerical value in rectangular coordinate system in space A in x, y, z axis direction is a1x、a1y、a1z, acceleration of gravityIt can be by parallelogram It is decomposed on the x of normal direction rectangular coordinate system in space A, z-axis, obtains relationship
The angle theta between vehicle and level road, i.e. road gradient can be calculated, calculation formula is
Further, when vehicle remains static, pilot control steering wheel clockwise slowly turn around by rotation, another mistake Hour hands, which slowly revolve, to turn around, and gravity accelerometer J2, J3 detect vehicle acceleration, when gravity accelerometer J2 is detected Numerical value maximum point on to its x-axis, gravity accelerometer J3 is detected when numerical value maximum point in its y-axis, it is specified that the position is The initial position S of steering wheel, the point where gravity accelerometer J2, J3 are respectively origin o, o'.
When steering wheel is located at initial position S, acceleration transducer J2, J3 detect that the numerical value on x, y, z axis is respectively a2xAnd a3x、a2yAnd a3y、a2zAnd a3z, meet
a2z=a3z,
Since the direction of acceleration of gravity is all acceleration of gravity straight downIt can be empty by parallelogram normal direction Between the x of rectangular coordinate system A, decomposed in z-axis, relationship can be obtained:
Then steering wheel plane and vehicle body transverse direction angle α can be byIt acquires.
Further, when the vehicle is running, vehicle generates total accelerationGravity accelerometer J1, J2, J3 inspection The acceleration of each axis is measured, the largest interval time of gravity accelerometer J1, J2, J3 detection data is 2 milliseconds, single-chip microcontroller The time interval that D1, D2 read gravity accelerometer J1, J2, J3 detection data can be by user at 10 milliseconds to 200 millis It is freely set between second, single-chip microcontroller D1, D2 obtain gravity accelerometer J1, J2, J3 by time interval set by user Detection data.
Further, single-chip microcontroller D2 obtains the data of gravity accelerometer J2, J3 detection, carries out data processing, leads to It crosses bluetooth module L2 and acceleration information and time data is sent to single-chip microcontroller D1, single-chip microcontroller D1 receives number by bluetooth module L1 According to single-chip microcontroller D1 receives the data of gravity accelerometer J1 transmission simultaneously.
Further, temporally data handle the detection data of synchronization to single-chip microcontroller D1, when steering wheel is located at When initial position S, by vehicle accelerationIt decomposes on each axis of rectangular coordinate system in space C, sets numerical value on each axis at this time For acx、acy、acz, calculation formula is
When one angle γ of pilot control direction disc spins, acceleration transducer J2, J3 can be detected on its x-axis to be added Speed values are a2x'、a3x', detect that acceleration value is a on the y axis2y'、a3y', detect that acceleration value is in z-axis a2z'、a3z', what acceleration transducer J2, J3 was detected at this time is vehicle entirety acceleration in rectangular coordinate system in space B1, B2 couple Each axis decomposed after numerical value, on the basis of rectangular coordinate system in space C, data that acceleration transducer J2 is measured meet
Simultaneous Equations (1) are available:
Steering wheel rotation angle γ is gone out by first equation solution of equation group (3)11, formula are as follows:
Steering wheel rotation angle γ is gone out by second equation solution of equation group (3)12, formula are as follows:
Wheel steering angle γ1Calculation formula are as follows:
On the basis of rectangular coordinate system in space C, the data that acceleration transducer J3 is measured meet:
Simultaneous Equations (1) are available:
Steering wheel rotation angle γ is gone out by first equation solution of equation group (5)21, formula are as follows:
Steering wheel rotation angle γ is gone out by second equation solution of equation group (5)22, formula are as follows:
Wheel steering angle γ1Calculation formula are as follows:
The calculation formula of wheel steering angle γ are as follows:
When single-chip microcontroller D1 is calculated | γ1112|≥2°、|γ2122|≥2°、|γ12| at >=2 °, single-chip microcontroller D1 not output data packet prompts result mistake.
Further, after single-chip microcontroller D1 calculates steering wheel angle, due to vehicle shake etc., acceleration can be sawed Dentation fluctuation, therefore data need to be filtered, mode is filtered are as follows: single-chip microcontroller D1 arbitrarily obtains continuous five moment Steering wheel rotational angle data and store, carry out curve fitting, predict next steering wheel angle number by plots changes According to, and export the steering wheel angle data of the curve matching at this moment;
Data are sent, steering wheel angle data are first converted to serial data, JC by JC communications protocol by single-chip microcontroller D1 Communications protocol regulation: all data are converted into ASCII transmission, and each data packet includes 25 data/characters, and the 1st, 2 is number According to packet header " JC ";3rd to 11 for when meta position, format be "+two bps clock+three milliseconds of number of+two the number of minutes of two hourages Number ";12nd to 13 is direction position, and format is " direction of rotation+one number of full circle position in position ", direction of rotation position regulation inverse time Needle is 0, is clockwise 1;14th to 18 is current steering wheel angle of rotation degree, and format is " three whole degree+decimal points+one Position decimal ";19th to 20 bit check position, verification rule be the data of front the 1st to 18 be converted into hexadecimal after sum, take and Number removes 256 remainder;21st to 25 is estimated steering wheel angle of rotation degree, and format is " three whole degree+decimal points+one Decimal ";Single-chip microcontroller D1 exports the data packet of the period, 8 data bit, 1 stop position, no odd even by serial communication module Verification, baud rate scope are 9600bps~115200bps.
Although specifically showing and describing the present invention in conjunction with preferred embodiment, those skilled in the art should be bright It is white, it is not departing from the spirit and scope of the present invention defined by the appended claims, it in the form and details can be right The present invention makes a variety of changes, and is protection scope of the present invention.

Claims (8)

1.一种方向盘转动角度的检测系统,其特征在于包括两个单元,其中:第一单元设有第一单片机和通过数据线与之相连的第一重力加速度传感器、第一蓝牙模块、串口通讯模块、他取电电源模块;第二单元设有第二单片机和通过数据线与之相连的第二重力加速度传感器、第三重力加速度传感器、第二蓝牙模块、自供电电源模块。1. the detection system of a steering wheel rotation angle, it is characterized in that comprising two units, wherein: the first unit is provided with the first single-chip microcomputer and the first gravitational acceleration sensor, the first bluetooth module, the serial port communication that is connected with it by the data line module, he power supply module; the second unit is provided with a second single chip microcomputer and a second gravitational acceleration sensor, a third gravitational acceleration sensor, a second bluetooth module, and a self-powered power supply module connected to it through a data cable. 2.根据权利要求1所述的方向盘转动角度的检测系统,其特征在于第一单元装在车身上,由车载电源提供电能;第一重力加速度传感器装在方向盘中心轴上靠近方向盘处,建立以车前进方向为x轴正方向、以垂直车身向下为z轴正方向且y轴与z轴正交在垂直车身平面的符合右手螺旋法则的空间直角坐标系A。2. The detection system of the steering wheel rotation angle according to claim 1 is characterized in that the first unit is installed on the vehicle body, and the electric power is provided by the vehicle power supply; The forward direction of the car is the positive direction of the x-axis, the positive direction of the z-axis is vertical to the body downward, and the y-axis and the z-axis are orthogonal to the vertical body plane. 3.根据权利要求1所述的方向盘转动角度的检测系统,其特征在于第二单元装在方向盘上,由自带电池的电源模块提供电能,第二重力加速度传感器装在方向盘未转动时方向盘中心轴上部,建立以方向盘中心轴向内为z轴正方向、以垂直方向盘轴线正向上为x轴正方向且y轴与x轴正交在方向盘平面的符合右手螺旋法则的空间直角坐标系B1;第三重力加速度传感器与第二重力加速度传感器互相垂直装在方向盘未转动时方向盘中心轴左部,建立以方向盘中轴向内为z轴正方向、以垂直方向盘轴线正向上为y轴正方向且x轴与y轴正交在方向盘平面的符合右手螺旋法则的空间直角坐标系B2;空间直角坐标系B1、B2的原点与两个重力加速度传感器重合,并随着两个重力加速度传感器与方向盘固联转动。3. the detection system of steering wheel rotation angle according to claim 1, it is characterized in that the second unit is installed on the steering wheel, is provided with electric energy by the power supply module of its own battery, the second gravitational acceleration sensor is installed in the steering wheel center when the steering wheel is not turned On the upper part of the shaft, establish a space Cartesian coordinate system B1 that conforms to the right-hand spiral rule, with the center axis of the steering wheel inward as the positive direction of the z-axis, the positive direction of the vertical steering wheel axis as the positive direction of the x-axis, and the y-axis and the x-axis are orthogonal to the steering wheel plane; The third gravitational acceleration sensor and the second gravitational acceleration sensor are installed perpendicular to each other on the left part of the central axis of the steering wheel when the steering wheel is not rotating. And the x-axis and the y-axis are orthogonal to the steering wheel plane and conform to the right-handed spiral rule. Fixed rotation. 4.根据权利要求1所述的方向盘转动角度的检测系统,其特征在于所述三个重力加速度传感器检测车辆的重力加速度和运动加速度在其传感器各个轴上的分量数值,第二单片机读取并处理第二和第三重力加速度传感器的检测数据,第一单片机读取和处理第一重力加速度传感器的检测数据和第一蓝牙模块的接收数据,计算出方向盘转动角度,通过串口通讯模块输出数据,第一单片机与第二蓝牙模块进行数据通讯。4. the detection system of steering wheel rotation angle according to claim 1 is characterized in that described three gravitational acceleration sensors detect the gravitational acceleration of vehicle and the component value of motion acceleration on each axis of its sensor, the second single-chip microcomputer reads and calculates. Processing the detection data of the second and third gravitational acceleration sensors, the first single-chip microcomputer reads and processes the detection data of the first gravitational acceleration sensor and the received data of the first Bluetooth module, calculates the rotation angle of the steering wheel, and outputs the data through the serial communication module , the first single-chip microcomputer communicates with the second bluetooth module. 5.根据权利要求4所述的方向盘转动角度的检测系统,其特征在于重力加速度传感器检测数据的最大间隔时间为2毫秒,单片机读取重力加速度传感器检测数据的时间间隔由用户在10毫秒到200毫秒之间自由设定,单片机按用户设定的时间间隔获取重力加速度传感器的检测数据。5. the detection system of steering wheel rotation angle according to claim 4, it is characterized in that the maximum interval time of the gravitational acceleration sensor detection data is 2 milliseconds, and the time interval that the single-chip microcomputer reads the gravitational acceleration sensor detection data is by the user in 10 milliseconds to 200 milliseconds. It can be freely set between milliseconds, and the single-chip microcomputer obtains the detection data of the gravitational acceleration sensor according to the time interval set by the user. 6.一种方向盘转动角度的检测方法,其特征在于包括以下步骤:6. a detection method of steering wheel rotation angle, is characterized in that comprising the following steps: Step1、系统初始化,建立空间直角坐标系A、B1、B2、C;第二单片机通过第二蓝牙模块向第一单片机发送同步时间数据,单片机在接收三个重力加速度传感器的检测数据后能够按同一时间进行处理数据;Step1. Initialize the system, establish the space rectangular coordinate system A, B1, B2, C; the second single-chip microcomputer sends the synchronization time data to the first single-chip microcomputer through the second Bluetooth module, and the single-chip microcomputer can press the same time to process data; Step2、在车辆处于静止状态时,第一重力加速度传感器检测得到重力加速度在空间直角坐标系A中z轴方向上的数值是a1z,按平行四边形法则进行分解,得到数学关系式a1z=gcosθ,计算得到车辆与水平路面之间的夹角θ,即路面坡度;Step2. When the vehicle is in a stationary state, the first gravitational acceleration sensor detects that the value of the gravitational acceleration in the z-axis direction of the space rectangular coordinate system A is a 1z , decomposed according to the parallelogram rule, and obtains the mathematical relationship a 1z = gcosθ , the angle θ between the vehicle and the horizontal road surface is calculated, that is, the road slope; Step3、在车辆处于静止状态时,驾驶员操纵方向盘顺时针缓慢旋转一圈,再逆时针缓慢旋转一圈,第二和第三重力加速度传感器检测车辆加速度,当第二重力加速度传感器检测到其x轴上数值最大点,第三重力加速度传感器检测到其y轴上数值最大点时,规定该位置为方向盘的初始位置S,第二和第三重力加速度传感器所在的点分别为原点o、o';Step3. When the vehicle is in a stationary state, the driver controls the steering wheel to slowly rotate clockwise once, and then slowly rotate counterclockwise once. The second and third gravitational acceleration sensors detect the acceleration of the vehicle. When the second gravitational acceleration sensor detects its The maximum value point on the x-axis, when the third gravitational acceleration sensor detects the maximum value on the y-axis, the position is defined as the initial position S of the steering wheel, and the points where the second and third gravitational acceleration sensors are located are the origin o respectively , o'; Step4、当车辆行驶时,车辆产生总的加速度第一、第二和第三重力加速度传感器检测到各轴的加速度;Step4. When the vehicle is driving, the vehicle generates a total acceleration The first, second and third gravitational acceleration sensors detect the acceleration of each axis; Step5、第二单片机获取第二和第三重力加速度传感器检测的数据,进行数据处理,通过第二蓝牙模块将加速度数据和时间数据发送给第一单片机,第一单片机通过第一蓝牙模块接收数据,第一单片机同时接收第一重力加速度传感器传送的数据;Step5. The second single-chip microcomputer obtains the data detected by the second and third gravitational acceleration sensors, performs data processing, and sends the acceleration data and time data to the first single-chip microcomputer through the second Bluetooth module, and the first single-chip microcomputer receives the data through the first Bluetooth module. , the first single-chip computer simultaneously receives the data transmitted by the first gravitational acceleration sensor; Step6、第一单片机按时间数据对同一时刻的检测数据进行处理,当方向盘位于初始位置S时,将车辆加速度分解到空间直角坐标系C的各个轴上,此时设各个轴上数值为acx、acy、acz。当驾驶员操纵方向盘旋转一个角度γ,第二和第三重力加速度传感器会在其x轴上检测到加速度数值为a2x'、a3x',在y轴上检测到加速度数值为a2y'、a3y',在z轴上检测到加速度数值为a2z'、a3z',此时第二和第三重力加速度传感器检测到的是车辆整体加速度在空间直角坐标系B1、B2对各轴进行分解后的数值,可以求解出方向盘旋转角度γ11、γ12,公式为:Step6. The first microcontroller processes the detection data at the same time according to the time data. When the steering wheel is at the initial position S, the acceleration of the vehicle is accelerated. It is decomposed into each axis of the space rectangular coordinate system C, and the values on each axis are set as a cx , a cy , and a cz at this time. When the driver rotates the steering wheel by an angle γ, the second and third gravitational acceleration sensors will detect acceleration values a 2x ', a 3x ' on the x-axis, and a 2y ' on the y-axis , a 3y ', the acceleration values detected on the z-axis are a 2z ', a 3z ', at this time, what the second and third gravitational acceleration sensors detect is the overall acceleration of the vehicle in the space rectangular coordinate system B1, B2 for each The value after the axis is decomposed, the steering wheel rotation angles γ 11 and γ 12 can be solved, and the formulas are: 则方向盘转向角度γ1的计算公式为:Then the calculation formula of the steering wheel steering angle γ1 is: 以空间直角坐标系C为基准,由第三重力加速度传感器测得的数据可以求解出方向盘旋转角度γ21、γ22,公式为:Taking the space rectangular coordinate system C as the benchmark, the data measured by the third gravitational acceleration sensor can solve the steering wheel rotation angles γ 21 , γ 22 , the formulas are: 则方向盘转向角度γ2的计算公式为:Then the calculation formula of the steering wheel steering angle γ2 is: 故方向盘转向角度γ的计算公式为:Therefore, the calculation formula of the steering wheel steering angle γ is: Step7、第一单片机计算出方向盘转角后,将数据进行滤波处理,按JC通讯协议转化成串口数据后通过串口通讯模块输出数据。Step7. After the first single-chip microcomputer calculates the steering wheel angle, it filters the data, converts it into serial data according to the JC communication protocol, and then outputs the data through the serial communication module. 7.根据权利要求6所述的方向盘转动角度的检测方法,其特征在于,第一单片机对方向盘转角数据进行滤波处理,滤波处理方式为:第一单片机任意获取连续五个时刻的方向盘转动角度数据并储存,进行曲线拟合,按曲线变化趋势预测下一时刻方向盘转角数据,并将此时刻的曲线拟合的方向盘转角数据输出。7. The method for detecting a steering wheel rotation angle according to claim 6, wherein the first single-chip microcomputer performs filtering processing on the steering wheel rotation angle data, and the filtering processing method is: the first single-chip microcomputer arbitrarily obtains the steering wheel rotation angle data at five consecutive moments. And save, perform curve fitting, predict the steering wheel angle data at the next moment according to the curve change trend, and output the steering wheel angle data of the curve fitting at this moment. 8.根据权利要求6所述的方向盘转动角度的检测方法,其特征在于,JC通讯协议规定:所有数据转化为ASCII发送,每个数据包包括25个数据/字符,第1、2位为数据包头“JC”;第3至11位为时间位,格式为“两位小时数+两位分钟数+两位秒钟数+三位毫秒数”;第12至13位为方向位,格式为“一位旋转方向位+一位整圈数位”,旋转方向位规定逆时针为0、顺时针为1;第14至18位为当前方向盘转动角度数,格式为“三位整度数+小数点+一位小数”;第19至20位校验位,校验规则为前面第1至18位数据转化为十六进制后求和,取和数除256的余数;第21至25位为预计方向盘转动角度数,格式为“三位整度数+小数点+一位小数”。8. the detection method of steering wheel rotation angle according to claim 6 is characterized in that, JC communication protocol stipulates: all data are converted into ASCII and send, and each data packet comprises 25 data/characters, and the 1st and 2nd are data The header "JC"; the 3rd to 11th digits are the time digits, and the format is "two digits of hours + two digits of minutes + two digits of seconds + three digits of milliseconds"; the 12th to 13th digits are direction digits, and the format is "One rotation direction bit + one full circle bit", the rotation direction bit is specified as 0 for counterclockwise and 1 for clockwise; the 14th to 18th bits are the current steering wheel rotation angle, the format is "three integer degrees + decimal point + One decimal"; the 19th to 20th check digits, the check rule is that the first 1st to 18th digits are converted into hexadecimal and then summed, and the remainder of the sum is divided by 256; the 21st to 25th digits are expected The steering wheel rotation angle, the format is "three integer degrees + decimal point + one decimal point".
CN201910160489.1A 2019-03-04 2019-03-04 Method and system for detecting rotation angle of steering wheel Active CN109916362B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910160489.1A CN109916362B (en) 2019-03-04 2019-03-04 Method and system for detecting rotation angle of steering wheel

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910160489.1A CN109916362B (en) 2019-03-04 2019-03-04 Method and system for detecting rotation angle of steering wheel

Publications (2)

Publication Number Publication Date
CN109916362A true CN109916362A (en) 2019-06-21
CN109916362B CN109916362B (en) 2021-01-19

Family

ID=66963097

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910160489.1A Active CN109916362B (en) 2019-03-04 2019-03-04 Method and system for detecting rotation angle of steering wheel

Country Status (1)

Country Link
CN (1) CN109916362B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112407048A (en) * 2020-11-17 2021-02-26 北京理工大学 A system for measuring steering wheel angle and torque
CN113885483A (en) * 2021-09-06 2022-01-04 中汽创智科技有限公司 Vehicle remote control method and device
DE102023003721A1 (en) 2023-09-14 2024-06-20 Mercedes-Benz Group AG Device for detecting a steering angle of a vehicle

Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1208013A (en) * 1997-04-15 1999-02-17 株式会社丰田自动织机制作所 Industrial vehicle with power steering apparatus and steering wheel angle correction device
EP0957339A2 (en) * 1998-05-15 1999-11-17 DaimlerChrysler AG Method and device for measuring the inclination angle in transversely inclined curves
CN102826122A (en) * 2012-08-13 2012-12-19 广东好帮手电子科技股份有限公司 Automobile steering wheel rotation angle sensing system, steering control method and automobile
CN103072622A (en) * 2013-02-27 2013-05-01 湖南时代卓越汽车电子技术有限公司 Steering wheel steering angle sensor device
CN103245284A (en) * 2013-05-14 2013-08-14 福州大学 Gyroscope-chip-based steering wheel angle measurement method and device thereof
JP2014070939A (en) * 2012-09-28 2014-04-21 Advics Co Ltd Steering angle arithmetic unit of vehicle
CN104428194A (en) * 2012-07-06 2015-03-18 捷太格特欧洲公司 Improved method for determining the absolute angular position of the steering wheel of a motor vehicle
JP2015067218A (en) * 2013-09-30 2015-04-13 マツダ株式会社 Vehicle steering device and self-excited vibration detection method of steering wheel
CN204937228U (en) * 2015-08-31 2016-01-06 梁世彦 A kind of steering angle survey meter
US20160046323A1 (en) * 2013-04-11 2016-02-18 Zf Friedrichshafen Ag Sensor device and method for determining a steering angle of a vehicle and driver assistance system for a vehicle
CN206327436U (en) * 2016-12-12 2017-07-14 丹阳亿豪电子科技有限公司 A kind of handwheel for vehicle rotary angle transmitter system
CN107351915A (en) * 2017-07-12 2017-11-17 哈尔滨工业大学 A kind of corner of vehicle steering wheel information acquisition system and acquisition method
CN107585210A (en) * 2016-07-07 2018-01-16 厦门雅迅网络股份有限公司 A kind of method and device for detecting steering wheel for vehicle corner
CN107972734A (en) * 2017-10-31 2018-05-01 江苏理工学院 A kind of discontinuous test of electric automobile steering wheel corner and brake safe system
CN108116495A (en) * 2016-11-30 2018-06-05 厦门雅迅网络股份有限公司 Detect the method and system of steering wheel for vehicle corner variation
CN109318988A (en) * 2018-11-08 2019-02-12 中国科学技术大学 Method and system for detecting steering wheel angle of motor vehicle based on dual-axis accelerometer

Patent Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1208013A (en) * 1997-04-15 1999-02-17 株式会社丰田自动织机制作所 Industrial vehicle with power steering apparatus and steering wheel angle correction device
EP0957339A2 (en) * 1998-05-15 1999-11-17 DaimlerChrysler AG Method and device for measuring the inclination angle in transversely inclined curves
CN104428194A (en) * 2012-07-06 2015-03-18 捷太格特欧洲公司 Improved method for determining the absolute angular position of the steering wheel of a motor vehicle
CN102826122A (en) * 2012-08-13 2012-12-19 广东好帮手电子科技股份有限公司 Automobile steering wheel rotation angle sensing system, steering control method and automobile
JP2014070939A (en) * 2012-09-28 2014-04-21 Advics Co Ltd Steering angle arithmetic unit of vehicle
CN103072622A (en) * 2013-02-27 2013-05-01 湖南时代卓越汽车电子技术有限公司 Steering wheel steering angle sensor device
US20160046323A1 (en) * 2013-04-11 2016-02-18 Zf Friedrichshafen Ag Sensor device and method for determining a steering angle of a vehicle and driver assistance system for a vehicle
CN103245284A (en) * 2013-05-14 2013-08-14 福州大学 Gyroscope-chip-based steering wheel angle measurement method and device thereof
JP2015067218A (en) * 2013-09-30 2015-04-13 マツダ株式会社 Vehicle steering device and self-excited vibration detection method of steering wheel
CN204937228U (en) * 2015-08-31 2016-01-06 梁世彦 A kind of steering angle survey meter
CN107585210A (en) * 2016-07-07 2018-01-16 厦门雅迅网络股份有限公司 A kind of method and device for detecting steering wheel for vehicle corner
CN108116495A (en) * 2016-11-30 2018-06-05 厦门雅迅网络股份有限公司 Detect the method and system of steering wheel for vehicle corner variation
CN206327436U (en) * 2016-12-12 2017-07-14 丹阳亿豪电子科技有限公司 A kind of handwheel for vehicle rotary angle transmitter system
CN107351915A (en) * 2017-07-12 2017-11-17 哈尔滨工业大学 A kind of corner of vehicle steering wheel information acquisition system and acquisition method
CN107972734A (en) * 2017-10-31 2018-05-01 江苏理工学院 A kind of discontinuous test of electric automobile steering wheel corner and brake safe system
CN109318988A (en) * 2018-11-08 2019-02-12 中国科学技术大学 Method and system for detecting steering wheel angle of motor vehicle based on dual-axis accelerometer

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
KIM, WONHEE等: "Nonlinear Steering Wheel Angle Control Using Self-Aligning Torque with Torque and Angle Sensors for Electrical Power Steering of Lateral Control System in Autonomous Vehicles", 《SENSORS》 *
李浩等: "电动汽车方向盘绝对角位置传感器的研究", 《传感器与微系统》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112407048A (en) * 2020-11-17 2021-02-26 北京理工大学 A system for measuring steering wheel angle and torque
CN112407048B (en) * 2020-11-17 2022-02-11 北京理工大学 A system for measuring steering wheel angle and torque
CN113885483A (en) * 2021-09-06 2022-01-04 中汽创智科技有限公司 Vehicle remote control method and device
CN113885483B (en) * 2021-09-06 2024-05-28 中汽创智科技有限公司 Vehicle remote control method and device
DE102023003721A1 (en) 2023-09-14 2024-06-20 Mercedes-Benz Group AG Device for detecting a steering angle of a vehicle

Also Published As

Publication number Publication date
CN109916362B (en) 2021-01-19

Similar Documents

Publication Publication Date Title
CN109916362A (en) Method and system for detecting rotation angle of steering wheel
CN101975868B (en) A Speed Measuring System for Track Cycling
CN105823484B (en) A kind of integrated form inertial navigation measuring unit and corresponding measuring method
CN107351915A (en) A kind of corner of vehicle steering wheel information acquisition system and acquisition method
CN206797611U (en) The control system and moped of moped
CN101691127A (en) System for controlling motion balance of dual-wheel auto balancing electric vehicle
CN107685773A (en) A kind of automobile tire deflection angle measuring device and measuring method
CN102295002A (en) Method for obtaining wheel rotation signal characteristic quantity based on tangential acceleration curve of wheel
CN102589807B (en) A kind of based on wheel-loaded intelligent sensing wheel balancing measuring method
CN106080942A (en) A kind of Self-balancing electronic bicycle drive train system
CN102880181A (en) Inverted pendulum system as well as control circuit and control method thereof
CN110979336A (en) Real-time monitoring system for running attitude of vehicle body
CN205311359U (en) Electric motor car intelligent management system
CN206984243U (en) A kind of moped system that can utilize new energy continuation of the journey
CN203869794U (en) Wheel motion state vector acquisition apparatus
CN208915311U (en) A kind of signal acquisition processing circuit on bicycle
CN102169649B (en) Demonstration teaching aid of support trafficability of sandlot model vehicle
CN201945599U (en) Motor speed detection sensor
CN205594387U (en) Two -wheeled self -balancing car control circuit
CN116202782A (en) Heavy vehicle smoothness detection system and method based on CAN bus
CN206514942U (en) A kind of vibration of elevator acceleration wireless measuring system
CN205643377U (en) Bicycle speed sensor based on cell -phone
CN208411850U (en) It is a kind of for detecting the direction indicators cover of fatigue driving
CN207497931U (en) A kind of tower crane lift hook attitude detection and anti-sway device
CN208298377U (en) A kind of data acquisition device based on electric bicycle

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant