The present disclosure relates to methods and systems for radar alignment determination. Aspects of the invention relate to a control system for use with a vehicle having a radar sensor, a system comprising the control system and the radar sensor, a vehicle comprising the control system and the radar sensor, and a method for determining alignment of a radar system of a vehicle.
It is known to provide a vehicle, such as a wheeled vehicle, with a radar sensor. The radar sensor may be configured to detect objects in the vicinity of the vehicle. The detection of such objects may be used for a variety of functions, including autonomous driving functions and safety functions including automatic braking, which may be used to automatically activate the brakes of the vehicle to slow or stop the vehicle. For example, a radar sensor may be provided generally at the front of the vehicle, and on detecting decreasing distance between the vehicle and an object in the vicinity of the vehicle, may trigger an automatic braking system to avoid collision of the vehicle with the detected object.
A radar sensor emits radiation and receives a signal reflected from an object with a field of view of the radar sensor. The alignment of the radar sensor is important for its function i.e. for it to transmit and receive radiation from objects. If the radar sensor is misaligned in the vertical plane, that is if the radar sensor is facing too far up or down relative to its intended field of view, then the radar sensor may not correctly detect objects. In particular, emitted radiation may be directed toward the ground, or upward into the air rather than toward objects generally in the same vertical plane as the vehicle. Such operation of the radar sensor may be inconvenient for a driver of the vehicle as, for example, an autonomous function of the vehicle may not be available.
It is known to determine or monitor alignment of the field of view of the radar sensor with an axis of the vehicle. For example, it is known to monitor alignment of the radar sensor with respect to a vertical plane in front of the vehicle, or in other words, with respect to a longitudinal axis of the vehicle. That is, the radar sensor may be monitored to attempt to determine whether the radar sensor is correctly aligned such that it may correctly identify objects in the desired field of view of the radar sensor.
It is known to attempt to determine the alignment of the radar sensor by methods based on monitoring for detected objects over a period of time. For example, in the known methods, a radar system may be determined to be misaligned after a predetermined time period has expired whilst the vehicle is operational i.e. being driven and the radar sensor has not detected a sufficient number of objects. That is, it may be determined that the radar sensor is misaligned if the radar sensor does not detect a predetermined number of objects in a predetermined period of time of operation of the vehicle. The detection of objects may be based on radar sensor data output by the radar sensor which indicates a detection of an object. A radar sensor may be continuously receiving radar signals.
The known approaches for determining radar alignment or misalignment have a number of associated problems. Firstly, if radar alignment is based on a number of detections of objects, and the vehicle is operated in an area with few objects, such as a quiet country road, the radar system may be determined to be misaligned even if it is in fact correctly aligned. This may trigger warnings or error messages which may concern or inconvenience the user if the vehicle must then be taken for professional maintenance to clear the error log. If the radar sensor is associated with automated functions, these may be deactivated by the vehicle if the radar sensor is determined as misaligned. Therefore, it is preferable to avoid false positive detections of radar misalignment.
To avoid such false positives, the approaches discussed above may in some examples include a delay after determining that the radar sensor is likely to be misaligned in case the radar sensor detects an object and it can be determined that the radar sensor is not misaligned. However, this leads to a further problem, in that in the case of genuine radar sensor misalignment, it may take an undesirably long time to determine that the radar sensor is misaligned.
It is an aim of the present invention to address one or more of the disadvantages associated with the prior art.
Aspects and embodiments of the invention provide a control system, a system, a vehicle and a method for determining alignment of a radar sensor in a vehicle as claimed in the appended claims.
According to an aspect of the present invention there is provided a control system for use with a vehicle having a radar sensor, the control system being configured to:
According to another aspect of the invention, there is provided a control system for use with a vehicle having a radar sensor, the control system comprising one or more controller, the control system being configured to:
wherein the at least one detection having an associated quality measurement below the threshold quality is only used for the second alignment determination process.
Advantageously, the method, and in particular the second alignment determination process, reduces the number of false positive determinations of radar misalignment, by making use of a larger number of detections including low quality detections. For example, in an environment with few detections of objects, the first alignment determination process may determine the radar sensor as misaligned. However, the second alignment determination process may determine the first determination as incorrect based on a less restrictive use of radar data. The low quality detections may be determined as valid detections of stationary objects around the vehicle by virtue of the relative speed comparison. By comparing the relative speed of each detected object to the associated speed of the vehicle, the detected object may be determined to be a stationary object existing around the vehicle.
In certain embodiments, the associated speed is the speed of the vehicle at the time of the respective detection. Advantageously, a detection may be determined to indicate a stationary object around the vehicle if the relative speed of the detected object is similar to the associated speed of the vehicle at the time the object was detected.
In certain embodiments, the quality measurement is a power measurement. Advantageously, low quality measurements may be disregarded for the first alignment determination process, and processing efficiency may be maintained. Advantageously, low quality data may be used to perform a second alignment determination process to confirm or refute the output of the first alignment determination process.
In certain embodiments, the first alignment determination process only uses detections having an associated quality above the threshold quality measurement. Advantageously, processing efficiency is improved, as the amount of data processed in the initial first process is reduced.
In certain embodiments, the second alignment determination process is performed dependent on the first alignment determination process. The second process may be performed when the first process is unable to determine correct alignment of the field of view of the radar sensor and the longitudinal axis of the vehicle. Advantageously, processing efficiency is improved as the second process is only used when the first process is unable to determine alignment. Thus, efficient processing using the high quality radar data used by the first process is achieved and the second alignment determination process is only invoked when required.
In certain embodiments, the detections used for the initial determination of the alignment are also used for control of one or more of vehicle parameters e.g. speed, steering etc. This may be known as Advanced Driver Assistance Systems (ADAS) control. The one or more detections used in the second alignment determination process are detections not used for ADAS control of the vehicle. ADAS may include functions of the vehicle which provide assistance to the driver. Advantageously, the system may continue to operate even when few high quality detections are detected.
In certain embodiments, the second alignment determination process comprises determining that the radar sensor is aligned when at least a proportion of the one or more detected objects have respective relative speeds substantially similar to the associated speed of the vehicle. The detected objects having respective relative speeds substantially similar to the associated speed of the vehicle are determined as stationary objects existing around the vehicle. Advantageously, valid detections of stationary objects can be used to determine that the radar sensor is not misaligned even when few or no high quality detections are present. The radar sensor is not falsely determined as misaligned in an environment with few high quality objects.
In certain embodiments, to compare the relative speed of each of the one or more detected objects to the associated speed of the vehicle, the control system is configured to determine the associated speed of the vehicle as a speed of the vehicle at a time each of the one or more objects were detected and to determine whether the relative speed of each of the one or more detected objects is within a speed window, wherein the speed window is determined in dependence on the associated speed of the vehicle. The speed window comprises an upper speed threshold and a lower speed threshold.
In certain embodiments, the upper speed threshold is determined as a speed greater than the associated speed of the vehicle by a predetermined percentage of the associated vehicle speed, and the lower speed threshold is determined as a speed less than the associated speed of the vehicle by the predetermined percentage of the associated vehicle speed. Advantageously, the second alignment determination process can determine radar sensor alignment at a variety of vehicle speeds.
In certain embodiments, the control system is configured to determine a proportion of detections having a relative speed within the speed window compared to a total number of the one or more detections; wherein the second alignment determination process comprises determining that the radar sensor is misaligned when the determined proportion of detections having a relative speed within the speed window is less than a first predetermined proportion. Advantageously, the system can determine that the radar sensor is detecting stationary objects existing around the vehicle and determine that the radar sensor is aligned.
In certain embodiments, the total number of the one or more detections is a number of detections within a predetermined period of time. Advantageously, a rolling time period ensures the system is operational as the vehicle moves between different environments.
In certain embodiments, the control system is configured to determine a distance between the vehicle and each of the one or more detected objects; and determine a proportion of detections of objects more than a predetermined distance away from the vehicle compared to the total number of the one or more detections; wherein the second alignment determination process comprises determining that the radar sensor is misaligned when the determined proportion of detections of objects more than a predetermined distance away from the vehicle is less than a second predetermined proportion. Advantageously, the presence of objects attached to the vehicle proximal to the radar sensor do not interfere with the alignment determination processes, and the range of detection of the radar sensor is checked to be at an appropriate level for correct alignment.
In certain embodiments, the second alignment determination process comprises: determining that the radar sensor is aligned when the determined proportion of detections having a relative speed within the speed window is greater than or equal to the first predetermined proportion, and the determined proportion of detections of objects more than a predetermined distance away from the vehicle is greater than or equal to the second predetermined proportion. Advantageously, false positive determinations of the radar sensor being misaligned using the first alignment determination process are overcome.
In certain embodiments, the predetermined distance is based on the associated speed of the vehicle. Advantageously, the predetermined distance is maintained at an appropriate level despite changes in the speed of the vehicle. In certain embodiments, the predetermined distance is determined as a distance travelled by the vehicle in a predetermined time. In certain embodiments, the predetermined time is two seconds.
In certain embodiments, the control system comprises output means configured to output an indication of misalignment of the radar sensor in dependence on the second alignment determination process. Advantageously, a user is made aware of radar sensor misalignment when the control system determines that the radar sensor is misaligned.
In certain embodiments, the control system is configured to control the output means to output the indication after a predetermined time has elapsed following the determination that the radar sensor is misaligned; or update a counter based on the associated vehicle speed, and output the indication when the counter reaches a predetermined number; wherein, when it is determined according to the second alignment determination process that the radar sensor is aligned, the control system is configured to reset the counter. Advantageously, the second alignment determination process reduces the number of false positive determinations of radar misalignment which are presented to the user.
In certain embodiments, the control system is configured to determine whether the vehicle is in an off-road environment, and trigger or suspend the determination of relative speed of the detected objects, the comparison of the detected object relative speed to the associated vehicle speed, and the second alignment determination process in dependence on the determination of whether the vehicle is in the off-road environment. Advantageously, the second radar sensor alignment process may be suspended when it is known that the vehicle is in an environment where the radar sensor is unlikely to detect many objects.
In certain embodiments, the control system is configured to: determine a number of channels of the radar sensor which detect an object among a plurality of channels of the radar sensor; trigger the determination of detected object relative speed, the comparison of the detected object relative speed to the associated vehicle speed, and the second alignment determination process when the number of channels of the radar sensor which detect objects is less than a predetermined number of channels; and suspend the determination of the detected object relative speed, the comparison of the detected object relative speed to the associated vehicle speed, and the second alignment determination process when the number of channels of the radar sensor which detect objects is equal to or greater than a predetermined number of channels. Advantageously, the second alignment determination process is only invoked when the radar sensor receives relatively little data. Therefore, the second alignment determination process is not invoked when sufficient data is available for confidence in the first alignment determination process to be high. Thus, processing efficiency is improved.
In certain embodiments, the second alignment determination process is performed when the first alignment determination process determines that the radar sensor is misaligned, or when the radar data comprises insufficient detections having associated quality measurements above the threshold quality for performing the first alignment determination process. Advantageously, processing efficiency is improved by only performing the second process when necessary.
In certain embodiments, the second alignment determination process is performed at the same time as the first alignment determination process. Advantageously, when a quality factor of the alignment, or a confidence in alignment, drops due to reduced object detection, the second alignment determination process may start to increase the quality factor before it reaches zero or a threshold for determining that the radar sensor is misaligned.
According to another aspect of the invention, there is provided a system comprising:
According to another aspect of the invention, there is provided a vehicle comprising the control system and a radar sensor.
According to another aspect of the invention, there is provided a method for determining alignment of a radar system of a vehicle, the method comprising:
wherein the at least one detection having an associated quality measurement below the threshold quality is only used for the second alignment determination process.
In certain embodiments, the received radar data may include a first signal which represents a velocity indicator for each detection. The first signal may be a “dsp.LocationData_TC.Location.i#.vMeas” signal received from a radar sensor. The received radar data may include a second signal which further includes a distance indicator for each detection. The second signal may be a “dsp.LocationData_TC.Location.i#.dMmeas” signal received from the radar sensor. The associated speed of the vehicle may be provided to the control system by being included in a signal received from a central processing unit of the vehicle. The speed of the vehicle may be determined from one or both of a navigation system or measured wheel rotations of the vehicle.
According to another aspect of the invention, there is provided computer software which, when executed by a computer, is arranged to perform the method; optionally the computer software is stored on a computer readable medium.
Within the scope of this application it is expressly intended that the various aspects, embodiments, examples and alternatives set out in the preceding paragraphs, in the claims and/or in the following description and drawings, and in particular the individual features thereof, may be taken independently or in any combination. That is, all embodiments and/or features of any embodiment can be combined in any way and/or combination, unless such features are incompatible. The applicant reserves the right to change any originally filed claim or file any new claim accordingly, including the right to amend any originally filed claim to depend from and/or incorporate any feature of any other claim although not originally claimed in that manner.
One or more embodiments of the invention will now be described, by way of example only, with reference to the accompanying drawings, in which:
A system 100 in accordance with an embodiment of the present invention is described herein with reference to the accompanying
The control system 110 of
The processing means 120 may comprise processing means which may be one or more electronic processing devices or processors which operably execute computer-readable instructions. The control system 110 further comprises an input means 140 which may be an electrical input to receive one or more electrical signals. The input means 140 may be configured to receive radar data from the radar sensor 160. The control system 110 may comprise an output means 130 which may be an electrical output 130 for outputting one or more control signals 135 under control of the processing means 120. The one or more control signals output by the output means 130 may include control signals associated with a determination of radar sensor alignment or radar sensor misalignment. For example, the output means 130 may output a control signal 135 to a communications bus of a vehicle indicative of a determination that the radar sensor 160 is misaligned. One or more further control systems or processing units communicatively coupled to the communication bus of the vehicle may control various functions of the vehicle in response to receiving the output control signal 135 from the output means 130. The output means 130 may further comprise a display or audible output means for outputting a visual or audio output to a user.
The memory means 150 may be one or more memory devices 150. The memory means 150 is electrically coupled to the processing means 120. The memory means 150 is configured to store computer-readable instructions, and the processing means 120 are configured to access the memory means 150 and execute the instructions stored thereon.
The system 100 of
The radar sensor 160 of
In some embodiments, the control system 110 of
The control system 110 of
Objects detectable by the radar sensor 160 may be man-made or natural objects. For example, in the typical environment of the vehicle 200 in use driving on a typical road, the radar sensor 160 may detect objects including stationary objects and moving objects. The stationary objects may include objects such as parked vehicles, road signs, streetlights and trees, while the moving objects may include other moving vehicles or pedestrians.
As discussed above, the radar sensor 160 may collect information including information related to the power of reflected signals, or a received signal strength indicator. The power of the reflected signal may be considered to indicate a quality of the detection. For example, a received signal having a high power may correspond to a detection of, without limitation, a large solid object such as a road sign or parked vehicle, while a received signal having a low power may correspond to a detection of a less solid or smaller object such as, without limitation, a small plant or animal at the side of the road. The power level of a received signal may be used by the radar sensor 160 or the control system 110 to infer a quality measurement of the detection and thereby determine whether the received signal should be used for certain functions or processes. For example, only high quality detections may be used to control automated functions of the vehicle 200, and low quality detections may not be used by the vehicle 200 for these purposes. The radar sensor 160 or the control system 110 may derive a quality measurement of detections of objects using alternative signal properties. In some examples, the radar sensor 160 or the control system 110 may determine a quality of radar detections over a period of time. High quality detections may be detections having a quality measurement above a threshold quality value, and low quality detections may be detections having a quality measurement below the threshold quality value.
The vehicle 200 may be an automotive i.e. land-going vehicle, such as a wheeled vehicle i.e. passenger vehicle or a goods vehicle. The vehicle 200 may be configured with functions including autonomous driving and automated safety functions such as those discussed above. For example, the vehicle 200 may be equipped with necessary components to perform automatic braking when the control system 110 in combination with the radar sensor 160 determine that a detected object is rapidly approaching the vehicle 200.
The vehicle 200 may be configured to output information to a user of the vehicle 200. For example, the vehicle 200 may comprise a display or warning lights which may inform the user of errors or warnings determined by the vehicle 200. For example, the vehicle 200 may output an indication to the user if it is determined that the radar sensor 160 is not correctly aligned. The alignment of the radar sensor 160 may refer to an alignment of a field of view of the radar sensor 160 with a longitudinal axis of the vehicle 200.
The control system 110 of the vehicle 200 is further configured to monitor properties of the vehicle 200. For example, the control system 110 may detect and monitor the speed of the vehicle 200, and the orientation of the vehicle 200 with respect to gravity to determine whether the vehicle 200 is on a surface having a particular gradient such as a steep slope, which may indicate that the vehicle 200 is in an off-road environment. An environment may be determined or referred to as an off-road environment based on characteristics of the environment. The off-road environment may be where a navigable path is not formed by a metaled road surface i.e. the navigable path has a natural surface. For example, an off-road environment may include a desert or beach, where no road is present and where few objects exist around the vehicle 200. Alternatively, the off-road environment may include any area with no road, or with poor quality or dirt roads. The off-road environment may also include particularly steep inclines, and as such be detectable by the vehicle 200 using information about the orientation of the vehicle 200. The off-road environment is not limited to the aforementioned examples, but should be understood to mean any environment where few objects detectable by a radar sensor exist. In some examples, and as discussed above, the control system 110 may receive signals from other processors of the vehicle which include information relating to the vehicle 200 speed and orientation using the input means 140. The control system 110 may process the received signals and extract the information relating to the vehicle 200 speed and orientation.
In block 310 radar data is received 310 from the radar sensor 160. The radar data comprises information indicating detections of one or more objects in the field of view of the radar sensor 160. For example, the radar data may include, for each detection, an identification value to identify each of the detections and one or more of information regarding the power level of the received signal, the distance between the radar sensor 160 and the detected object, the speed of the detected object, and other information related to the detected object. Alternatively, the radar sensor 160 may not calculate the speed of the detected object, and the speed of the detected object may be determined by the control system 110 based on monitoring the distance of a detected object using a plurality of detections of the same object over a period of time. The radar data may indicate a channel of the radar sensor 160 which receives the signal indicative of each detection, and may indicate a total number of channels of the radar sensor 160. The radar data may be received from the radar sensor 160 continuously over a period of time.
At block 320, the control system 110 performs a first alignment determination. The control system 110 performs the first alignment determination to determine whether the field of view of the radar sensor 160 is aligned with a longitudinal axis of the vehicle 200. The first alignment determination process may be a radar alignment process which uses only high quality detections to determine alignment of the radar sensor 160. For example, the first alignment determination process may include determining a quality score based on a number of detections of objects over a period of time. When the quality score reaches a predetermined threshold, the radar sensor 160 may be determined as misaligned. Alternatively, when the quality score reaches the predetermined threshold, the control system 110 may begin adjusting a point counter. The rate of adjustment of the point counter may be based on the speed of the vehicle 200. For example, the point counter may be adjusted more quickly when the vehicle 200 has a higher speed. The radar sensor 160 may be determined to be misaligned when the point counter reaches a predetermined threshold. Optionally, the point counter may be reset if the system 100 identifies an object before the predetermined threshold is reached.
The first alignment determination process may be performed using only high quality detections of objects. High quality detections of objects may be determined as objects which have a quality measurement above a predetermined threshold quality. The quality measurement may be determined based on a power level of the received signals included in the radar data. For example, high quality detections of objects may be identified in the radar data as detections of objects which have a signal power greater than a threshold power. The first alignment determination process may use a limited range of detected objects to reduce processing power.
At block 325, the method comprises determining whether to perform a second alignment determination process 360. If it is determined to perform the second alignment determination process 360, the method continues to block 330. If it is determined not to perform the second alignment determination process 360, the method returns to block 310. As is discussed below, the second alignment determination process 360 may be selectively performed. The second alignment determination process 360 may be performed in dependence on the first alignment determination process or if the control system 110 does not have sufficient high quality data to perform the first alignment determination process.
At block 330, the control system 110 determines a relative speed of each detected object. The relative speed of each detected object may be a speed relative to the speed of the vehicle 200. For example, a stationary object may be determined to have a relative speed which is the inverse of the vehicle 200 speed. A moving object moving at the same speed in the same direction as the vehicle 200 would be determined to have a relative speed of zero. The relative speed of each detected object may be determined using known techniques for determining speed of objects detected using a radar sensor 160, such as by considering reflected signal properties or Doppler effect.
At block 340, the control system 110 compares the determined relative speed of each detected object to the associated speed of the vehicle 200. The associated speed of the vehicle 200 is the speed of the vehicle 200 at the time when the object was detected. In some embodiments, the comparison comprises comparing the relative speed of each detected object to the associated speed of the vehicle 200, and determining whether the relative speed of each detected object is substantially similar to the associated speed of the vehicle 200. The comparison may include determining whether the inverse of the relative speed of each detected object is substantially similar to the associated speed of the vehicle 200. For example, a stationary object detected by the radar sensor 160 would have a relative speed close to the inverse of the associated speed of the vehicle 200. Such a detection would be considered substantially similar to the associated speed of the vehicle 200.
In some embodiments, the relative speed of each detected object is substantially similar to the associated speed of the vehicle 200 when the relative speed of each detected object is within a predetermined range around the associated speed of the vehicle 200. The predetermined range around the associated speed of the vehicle 200 may include an upper threshold and a lower threshold, which may respectively be determined by adding to and subtracting from the associated vehicle speed a predetermined amount. The predetermined amount may be a predetermined value, such as 5 miles per hour, or may be based on the associated vehicle speed, such as 5% of the associated vehicle speed. The upper and lower thresholds may together form a speed window or an envelope around the associated speed of the vehicle 200.
The comparison 340 of the determined relative speed of each detected object to the associated speed of the vehicle 200 may comprise determining the associated speed of the vehicle 200 as a speed of the vehicle 200 at a time each of the one or more objects were detected, and determining whether the relative speed of each of the one or more detected objects is within the speed window.
The method 300 of
In this case, objects having a relative speed within the speed window around the associated speed of the vehicle 200 are likely to be detected stationary objects. The determination that a proportion of detections of objects by the radar sensor 160 have a relative speed similar to the associated speed of the vehicle 200 indicates that the radar sensor 160 is detecting a number of stationary objects in the environment of the vehicle 200. Thus, the radar sensor 160 is determined to be aligned. The second alignment determination process 360 may therefore make use of all detections by the radar sensor 160, unlike the first alignment determination process, which may only use detections having at least a predetermined quality measurement.
The second alignment determination process 360 may further comprise determining whether the detected objects are within a predetermined distance from the vehicle 200. The predetermined distance may be based on the speed of the vehicle 200. For example, the predetermined distance may be determined as a distance travelled by the vehicle 200 in a predetermined amount of time, such as 2 seconds. The predetermined amount of time may vary. For example, the predetermined amount of time may range from 1 second to 5 seconds. The predetermined amount of time may be dependent on the environment of the vehicle 200 or information about the user. For example, the predetermined period of time may be longer when the vehicle 200 is in an off-road environment. The determination of whether the detected objects are within the predetermined distance from the vehicle 200 may be included as an additional step in the second alignment determination process 360 to determine whether the radar sensor 160 is aligned. For example, if a proportion of detected objects are below a threshold distance from the vehicle 200, then the detections may indicate objects attached to the vehicle 200 rather than objects existing in the environment of the vehicle 200, such as objects at the side of a road. Therefore, the second alignment determination process 360 may further comprise a step of determining whether the proportion of detections having a respective relative speed substantially similar to the associated speed of the vehicle 200 include a proportion of detections having a distance from the vehicle 200 greater than a predetermined distance. The second alignment determination process 360 may comprise determining that the radar sensor 160 is aligned when there is a proportion of detections having a distance from the vehicle 200 greater than a predetermined distance greater than a predetermined proportion, and a proportion of detected objects having a relative speed substantially similar to the associated speed of the vehicle 200.
The second alignment determination process 360 of
The second alignment determination process 360 may be used to confirm or validate the determination of alignment from the first alignment determination process. For example, the first alignment determination process may determine that the radar sensor 160 is misaligned if few high quality detections are detected by the radar sensor 160. However, the second alignment determination process 360 may make use of all detections including low quality detections, and determine that the radar sensor 160 is in fact detecting valid objects in the environment of the vehicle 200, and thus that the radar sensor 160 is correctly aligned. The second alignment determination process 360 may therefore overwrite the output of the first alignment determination process. The second alignment determination process 360 may therefore optionally include suppressing error messages or warnings that the radar sensor 160 is misaligned triggered by the first alignment determination process. The second alignment determination process 360 may reset a timer or point counter triggered by the first alignment determination process if the second alignment determination process 360 determines that the radar sensor 160 is aligned.
The method 300 may optionally further comprise outputting a warning or message to a user that the radar sensor 160 is misaligned if the second alignment determination process 360 determines that the radar sensor 160 is misaligned. Optionally, this may be output after expiry of a timer or reaching of a threshold count by a point counter triggered by the determination by the second alignment determination process 360 that the radar sensor 160 is misaligned. The timer or point counter may optionally be reset if either the first or second alignment determination processes 360 subsequently determine that the radar sensor 160 is aligned.
The determination 330 of relative speed of each detected object, the comparison 340 of the respective relative speeds of each detected object to the associated speed of the vehicle 200 and the performing 350 of the second alignment determination process 360 may be selectively performed in dependence on the first alignment determination process. In some examples, the determination 330 of relative speed of each detected object, the comparison 340 of the respective relative speeds of each detected object to the associated speed of the vehicle 200 and the performing 350 of the second alignment determination process 360 are performed only when the first alignment determination process determines that the radar sensor 160 is misaligned.
Alternatively or in addition, the determination 330 of relative speed of each detected object, the comparison 340 of the respective relative speeds of each detected object to the associated speed of the vehicle 200 and the performing 350 of the second alignment determination process 360 may be performed if the radar sensor 160 does not provide sufficient detections having a high enough quality to perform the first radar alignment determination process. For example, the determination 330 of relative speed of each detected object, the comparison 340 of the respective relative speeds of each detected object to the associated speed of the vehicle 200 and the performing 350 of the second alignment determination process 360 may be performed if the radar data received from the radar sensor 160 includes detections on a number of channels of the radar sensor 160 below a predetermined number of channels. That is, the second alignment determination process 360 may be invoked only if the radar sensor 160 is detecting objects with a low enough proportion of channels of the radar sensor 160. The second alignment determination process 360 may be suppressed if the radar sensor 160 is detecting objects on a sufficiently high enough proportion of the plurality of channels of the radar sensor 160.
The method 300 of
Advantageously, the second alignment determination process 360 enables a determination of radar sensor 160 alignment to be improved. For example, the second alignment determination process 360 can be performed when insufficient high quality detections are available for performing the first alignment determination process. Thus, alignment of the radar sensor 160 can be checked even in environments where few objects are present. This may include quiet roads, beaches, or other environments with few large or metallic objects which typically produce high quality detections. Thus, false positive determinations of the radar sensor 160 being misaligned can be reduced.
In addition, the second alignment determination process 360 can improve the confidence of a determination that the radar sensor 160 is misaligned, by performing a second check using a larger amount of radar data. That is, if both the first and second alignment determination processes 360 determine that the radar sensor 160 is misaligned, the confidence in such a determination is higher than using a single process alone.
Further, the use of the second alignment determination process 360 can be combined with a reduction in a time or counter threshold for triggering error messages or disabling functions of the vehicle, which may be triggered as a result of determining that the radar sensor 160 is misaligned and discussed above. For example, because the second alignment determination process 360 can validate or check the determination of misalignment by the first radar alignment determination process, the time allowed for detecting a new object to reset a timer or counter can be reduced. Thereby, the time taken for the system to determine that the radar sensor 160 is misaligned is reduced in cases of valid misalignment, and the vehicle 200 is able to react more quickly to a valid misalignment of the radar sensor 160.
If the vehicle 200 is not determined to be in an off-road environment, the method includes determining at block 530 whether a quality score is less than a threshold quality. The quality score in some embodiments may be a DSP quality score. The DSP quality score may be based on a received power of radar detections, but may substituted for any quality measurement. The threshold quality may be 0.9, but this is an example only. The determination 530 of whether the quality score is less than a threshold quality may be replaced by the first alignment determination process of
If the quality score is less than the predetermined threshold quality, the method includes counting at block 540 the number of non-zero detections of objects in the received radar data. In this example, non-zero detections means data points in the radar data which have a signal power greater than zero, and thus indicate some received radar signal which has been reflected from an object. Thus, the non-zero detections are indicative of objects. The quality score may be low if few detections are recorded, or if detections recorded by the radar sensor 160 have a low quality. A low quality score may be indicative of a misaligned radar sensor 160 according to typical alignment determination processes. The counting performed at block 540 may be based on a signal received from a radar sensor which includes information on a velocity indicator for each detection.
The method of
If the determined ratio is greater than the threshold, the method includes determining at block 570 if a proportion of the detected objects are greater than a predetermined distance from the vehicle 200. As explained above, if the detected objects are largely close to the vehicle 200, this may be indicative of an object attached to the vehicle 200 rather than valid detections of objects existing in the environment of the vehicle 200. The predetermined distance may be determined based on the speed of the vehicle 200. For example, the predetermined distance may be determined as the distance travelled by the vehicle 200 in a predetermined amount of time, such as two seconds. The determining performed at block 570 may be based on a signal received from a radar sensor which includes information on a velocity indicator for each detection. The determining performed at block 570 may further be based on a signal received from a radar sensor which includes information on a distance indicator for each detection. The determination at block 570 may comprise using said received signals to determine whether the distance indicator for each detection is greater than a multiple of the corresponding velocity indicator for each detection. That is, for each detection, it may be determined whether the detected object is more than a threshold distance from the vehicle at the time of the detection, where the threshold distance is determined based on the relative velocity of the detected object at the time of the detection. Alternatively, the threshold distance may be determined based on the associated speed of the associated speed of the vehicle 200 at the time of the detection. Block 570 may then further comprise determining if a proportion of the detected objects are greater than the threshold distance from the vehicle. For example, the proportion may be 0.5, or 50%. However, this is merely an example, and the proportion may be configured to be a different value.
The distance and velocity indicators may refer to a longitudinal distance and velocity in the case of a radar sensor 160 which is provided at the front of a vehicle 200. In some examples, the radar sensor 160 may be provided on a corner of the vehicle 200, and thus have a field of view which is at an angle with respect to a longitudinal axis of the vehicle 200. In this case, the information used for the method of
If the ratio determined at block 560 of detected objects having a speed within the range of the vehicle speed relative to the total number of counted detections of objects is less than the predetermined proportion then a point based counter is adjusted at block 580. In addition, if the determined 560 ratio of detected objects having a speed within the range of the vehicle speed relative to the total number of counted detections of objects is greater than the predetermined proportion, but the proportion of the detected objects are less than the predetermined distance from the vehicle 200, then the method also includes adjusting at block 580 the points based counter. Although not shown in
If the proportion of the detected objects are greater than the predetermined distance from the vehicle 200, the method includes resetting at block 590 the point counter. In this case, the vehicle 200 determines that it is likely that the radar sensor 160 is aligned correctly, and the counter is reset to avoid a false positive determination of the radar sensor 160 being misaligned from being recorded.
The proportions and ratios discussed above may be based on a rolling time window. That is, the calculation of a ratio of a first number to a second number may be based on the values of the first and second numbers in the most recent predetermined time window, such as in the most recent 5 minutes.
Advantageously, embodiments of the invention discussed above achieve an improvement in radar alignment determination, as a larger amount of radar data unsuitable for conventional approaches can be used to perform a secondary alignment determination process to confirm or validate the determination made by a first alignment determination process. The first alignment determination process may be a typical alignment determination process which only uses high quality radar data to determine alignment of the radar sensor 160. The second alignment determination process may make use of all radar data by considering relative speed of detected objects to identify detections of valid stationary objects in the environment of the vehicle 200. The second alignment determination process may determine that the radar sensor 160 is aligned if sufficient valid stationary objects are determined a sufficient distance from the vehicle 200, and thus may correct an erroneous determination of radar misalignment by the first process. Thereby, false positive determinations of misalignment are reduced. The invention is particularly suitable for reducing false positive determinations of misaligned when the vehicle 200 is in an environment with few objects, or with few objects which produce high quality detections, such as environments without street signs.
Optionally, the second alignment determination process may be selectively performed. For example, the second alignment determination process may be performed only when the first alignment determination process determines that the radar sensor 160 is misaligned, or when insufficient high quality data is available to perform the first alignment determination process. Therefore, efficient processing is achieved as the second alignment determination process is only performed when necessary, and the first alignment determination process may be operated in conditions where sufficient high quality radar data is available.
Optionally, a traditional point counting logic may be used as part of the method of the invention, to allow a delay before determining that a radar sensor is misaligned and to reduce false positives of misalignment. Advantageously, a threshold used in such a system may be reduced in the present invention, as use of the second alignment determination process means that less time is required to identify valid stationary objects to determine that the radar sensor 160 is aligned because a greater amount of radar data is used for the second alignment determination process. Thereby, in the case of genuine radar sensor 160 misalignment, the time taken to identify the misalignment is reduced.
It will be appreciated that various changes and modifications can be made to the present invention without departing from the scope of the present application.
Number | Date | Country | Kind |
---|---|---|---|
2111661.1 | Aug 2021 | GB | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/EP2022/072700 | 8/12/2022 | WO |