Method of determination of alignment angles of radar sensors for a road vehicle radar auto-alignment controller
A method of determination of the alignment angles of two or more road vehicle ( 1 ) borne radar sensors ( 4 ) for a road vehicle radar auto-alignment controller ( 3 ) starting from initially available rough estimates of alignment angles. From at least two radar sensors ( 4 ) are obtained signals related to range, azimuth and range rate to detections. The detections are screened ( 5 ) to determine detections from stationary targets. From the determined detections from stationary targets is derived a linearized signal processing model involving alignment angles, longitudinal and lateral velocity and yaw-rate of the road vehicle ( 1 ). A filter algorithm is applied to estimate the alignment angles. Based on the estimated alignment angles are produced signals suitable for causing a road vehicle ( 1 ) radar auto-alignment controller ( 3 ) to perform radar offset compensation.
1. A method of determining alignment angles of at least two or more road vehicle borne radar sensors for producing signals suitable to cause a road vehicle radar auto-alignment controller to perform radar offset compensation starting from initially available rough estimates of the alignment angles, the method comprising:
obtaining, from the at least two or more road vehicle borne radar sensors, signals related to range, azimuth, and range rate to detections;
screening the obtained signals from the at least two or more road vehicle borne radar sensors to determine detections from stationary targets;
deriving, from the determined detections from stationary targets based on the obtained signals from the at least two or more road vehicles borne radar sensors, a linearized signal processing model involving the alignment angles, longitudinal and lateral velocity, and yaw-rate of the road vehicle, the linearized signal processing model linearized with respect to alignment angles having the initially available rough estimates of the alignment angles;
applying a Kalman filter algorithm to the linearized signal processing model to estimate the alignment angles for the at least two or more road vehicle borne radar sensors by combining the obtained signals from all of the at least two or more road vehicle borne radar sensors;
producing, based on the estimated alignment angles, the signals suitable to cause the road vehicle radar auto-alignment controller to perform the radar offset compensation.
2. The method according to claim 1 , further comprising obtaining the initially available rough estimates of the alignment angles from known nominal mounting angles of the at least two or more road vehicle borne radar sensors.
3. The method according to claim 1 , wherein the screening the detections to determine detections from stationary targets is done through monitoring longitudinal and lateral velocity and yaw-rate of the road vehicle together with the obtained range-rates of the detections.
4. The method according to claim 1 , wherein the screening the detections to determine detections from stationary targets is done using Random Sample Consensus (RANSAC) techniques or by running target tracking and looking at temporal effects.
5. The method according to claim 1 , wherein the deriving the linearized signal processing model is done by performing a Taylor series expansion of a rotation matrix involving the alignment angles.
6. A road vehicle system comprising a road vehicle radar auto-alignment controller that performs the radar offset compensation based on the signals produced in accordance with the method of claim 1 .
7. A road vehicle comprising a road vehicle system comprising a road vehicle radar auto-alignment controller that performs the radar offset compensation based on the signals produced in accordance with the method of claim 1 .
8. A computer program embodied on a non-transitory computer-readable storage medium, the computer program comprising program code for controlling a road vehicle radar auto-alignment controller to execute a process for road vehicle radar auto-alignment, the process comprising the method of claim 1 .
9. A computer program embodied on a non-transitory computer-readable storage medium, the computer program comprising instructions that when executed by a processing circuit is configured to cause the road vehicle system to perform the method according to claim 1 .
10. A method of determining alignment angles of at least two or more road vehicle borne radar sensors for producing signals suitable to cause a road vehicle radar auto-alignment controller to perform radar offset compensation starting from initially available rough estimates of the alignment angles, the method comprising:
obtaining, from the at least two or more road vehicle borne radar sensors, signals related to range, azimuth, and range rate to detections;
screening the obtained signals from the at least two or more road vehicle borne radar sensors to determine detections from stationary targets;
deriving, from the determined detections from stationary targets based on the obtained signals from the at least two or more road vehicles borne radar sensors, a linearized signal processing model involving the alignment angles, longitudinal and lateral velocity, and yaw-rate of the road vehicle, the linearized signal processing model linearized with respect to alignment angles having the initially available rough estimates of the alignment angles;
estimating the alignment angles for the at least two or more road vehicle borne radar sensors by applying a Kalman filter algorithm to the linearized signal processing model by combining the obtained signals from all of the at least two or more road vehicle borne radar sensors; and
performing the radar offset compensation, based on the estimated alignment angles, by the road vehicle radar auto-alignment controller.
11. The method of claim 10 , wherein the radar offset compensation is a difference between the initially available rough estimates of the alignment angles and the estimated alignment angles.
12. A method of performing radar offset compensation of at least two or more road vehicle borne radar sensors, the method comprising:
obtaining, from the at least two or more road vehicle borne radar sensors, signals related to range, azimuth, and range rate to detections;
screening the obtained signals from the at least two or more road vehicle borne radar sensors to determine detections from stationary targets;
deriving, from the determined detections from stationary targets based on the obtained signals from the at least two or more road vehicles borne radar sensors, a linearized signal processing model involving alignment angles, longitudinal and lateral velocity, and yaw-rate of the road vehicle, the linearized signal processing model linearized with respect to initially available rough estimates of the alignment angles;
estimating the alignment angles for the at least two or more road vehicle borne radar sensors by applying a Kalman filter algorithm to the linearized signal processing model by combining the obtained signals from all of the at least two or more road vehicle borne radar sensors; and
causing a road vehicle radar auto-alignment controller to perform the radar offset compensation of two or more road vehicle borne radar sensors based on the estimated alignment angles.