1. Field of the Invention
This invention generally relates to motor vehicle sensor systems. More specifically, the invention relates to motor vehicle sensor systems having sensors that determine misalignment of a directional sensor.
2. Description of Related Art
In motor vehicle design, vehicle sensor systems are becoming increasingly important. Vehicles often include sensor systems used to sense the presence and distance of other vehicles traveling nearby, to alert the driver, or to automatically deploy certain safety and dynamic stability systems. Sensor systems may be configured to trigger vehicle safety systems or vehicle reaction systems, such as automatic braking or reduction of engine torque upon the occurrence of predetermined conditions. Such sensor systems may be used to provide a signal into a feedback control system. For example, a forward-sensing radar sensor may be part of a feedback control system that controls the speed of a vehicle based upon the distance of the vehicle traveling in front of it.
Other types of forward-looking sensors may use light or acoustic signals, or may use other forms of electromagnetic radiation, either actively (with an emitter) or passively (detection only). For the purposes of this description, a “forward-looking sensor” is any sensor oriented in a specific direction to detect conditions outside of the sensor. The “forward” is related to the sensor itself and not necessarily the forward direction of vehicle travel.
These types of vehicle forward-looking sensor systems must be very accurately aligned with respect to a geometric axis of a vehicle in order to properly sense the surrounding conditions that they are intended to measure. For example, the boresight of the sensor assembly might be required to be aligned with the direction of travel of the vehicle. If such a sensor assembly is not properly aligned, there must be compensation for misalignment in order to obtain a proper reading from the sensor assembly. Misalignment may result in mismeasurement of the desired surrounding circumstances. Such mismeasurement is undesirable because it may cause customer dissatisfaction and/or system performance concerns.
Various methods have been employed to determine sensor misalignment in the context of motor vehicles. For example, one known method of aligning a radar system is by using a second radar system to sense stationary objects along the side of the road. If the second radar senses that the objects are moving toward or away from the vehicle in a direction perpendicular to the direction of travel, it is evident that the first sensor assembly is misaligned. This method may be undesirable due to its complexity and costs.
Another known method of aligning a radar system is by aligning an optical axis with a light cone. This method may be undesirable because it may be time-consuming and costly to implement.
In view of the above, it is apparent that there exists a need for a system that is capable of efficiently determining whether a forward-looking sensor is misaligned.
In satisfying the above need, as well as overcoming the enumerated drawbacks and other limitations of the related art, the present invention provides a misalignment detection sensor assembly. The misalignment detection sensor assembly includes a forward-looking sensor having a sensing direction of design along a first axis and an inertia sensor configured to sense acceleration along a second axis, the second axis having a fixed relationship with respect to the first axis.
In another aspect, a misalignment detection system is provided. The system includes a sensor assembly including a forward-looking sensor having a sensing direction of design along a first axis and an inertia sensor configured to sense acceleration along a second axis, the second axis having a fixed relationship with respect to the first axis. The misalignment detection system also includes a signal processing system configured to receive an acceleration signal from the inertia sensor and calculate a misalignment angle between the first axis and a forward axis, the forward axis being parallel to a direction of motion.
In yet another aspect, a method of detecting angular misalignment of a forward-looking sensor assembly is provided. The method includes measuring acceleration along a first axis and outputting an acceleration signal, the first axis having a predetermined relationship with respect to a second axis, and the second axis extending along a sensing direction of design of a forward-looking sensor. The method further includes determining whether the second axis is substantially parallel with a forward axis, the forward axis extending along the direction of forward motion of the forward-looking sensor assembly. This determination is made by determining the value of the acceleration signal and comparing the value of the acceleration signal with a predetermined threshold.
Further objects, features, and advantages of this invention will become readily apparent to persons skilled in the art after a review of the following description, with reference to the drawings and claims that are appended to, and form a part of, this specification.
Referring now to
Referring to
It is possible, however, that XRAD could be misaligned from XCG, as shown in
Referring to
The inertia sensor 16 is operable to sense acceleration along the sensing axis YSEN. The inertia sensor 16 can sense acceleration through the use of one or more accelerometers, for example. In the present embodiment, the inertia sensor 16 is fixedly attached to the sensor package 14 such that the sensing axis YSEN extends parallel to the axis YRAD. In the alternative, it is contemplated that the sensing direction YSEN could extend along another axis that is not aligned with YRAD, and a mathematical equivalent to acceleration along the YRAD direction could be calculated.
To detect misalignment, the inertia sensor 16 measures acceleration along the YRAD direction. If the misalignment sensor assembly 12 is perfectly aligned with the direction of forward propulsion XCG, and the vehicle 10 is accelerated in a straight, forward direction, the component of acceleration along the YRAD direction should be zero, absent other external factors. If the YRAD axis is not perpendicular to the direction of forward propulsion XCG because the sensor assembly 12 is misaligned in a horizontal direction, rotated about the vertical axis ZCG of vehicle, the result is that a component of acceleration will be measured along the YRAD axis. Thus, if the acceleration along YRAD varies from zero, the sensor assembly 12 may be misaligned.
The angle of misalignment θ between the XRAD sensing direction and the vehicle propulsion axis XCG can be calculated by comparing the acceleration component along the YRAD direction with the acceleration of the vehicle. As one skilled in the art would understand, when the motor vehicle 10 is accelerated in a straight, forward direction, the larger the misalignment angle θ is, the higher the magnitude of acceleration measured in the YSEN direction will be, if other factors are kept constant.
Likewise, the sensor assembly 12 could be misaligned such that the sensor assembly 12 is rotated about the forward axis XCG of the motor vehicle 10. In other words, the sensor assembly 12 could be rotated about the roll axis of the motor vehicle 10, resulting in a vertical misalignment of the sensor assembly 12. In this configuration, the sensor assembly 12 could detect misalignment by accelerating the motor vehicle 10 in a vertical direction, for example, by causing the motor vehicle 10 to be accelerated in a vertical direction along its suspension system. If the sensor assembly 12 was perfectly aligned, YSEN should sense zero acceleration, absent external factors, when the motor vehicle 10 is accelerated in a vertical direction on a flat surface. However, if the sensor assembly 12 is vertically misaligned by being rotated about the roll axis XCG of the motor vehicle 10, YSEN will sense a component of acceleration in the vertical direction, when the motor vehicle 10 is accelerated in a vertical direction. As one having ordinary skill in the art would appreciate, in order to detect misalignment, it is preferable that the magnitude of the vertical acceleration measurement exceed the magnitude of any noise signals.
Referring to
Referring to
The calculated acceleration components aXRAD and aYRAD can be processed to determine whether the sensing direction of design XRAD is misaligned from the direction of forward propulsion XCG.
Alternatively, instead of converting the measurements for aXSEN1 and aXSEN2 into acceleration along the XRAD and YRAD directions, aXSEN1 and aXSEN2 could be simply compared to each other. As one skilled in the art would appreciate, if there is any substantial difference between acceleration along XSEN1 and XSEN2 (aXSEN1 and aXSEN2) when the vehicle 10 is accelerated along a straight, forward path, the sensor may be misaligned. In other words, if acceleration is measured along paths that are equally angularly separated from XRAD on each side of XRAD, then each should measure equal components of acceleration in the XRAD direction if XRAD is aligned with XCG. Likewise, if XRAD is misaligned from XCG, then acceleration along XSEN1 and XSEN2 will not be equal, because one will measure a greater component of acceleration due to the fact that one is more closely angularly aligned with the direction of forward propulsion XCG.
The XSEN1 and XSEN2 directions need not be located be located 45 degrees from the directions of XRAD and YRAD Instead, the XSEN1 and XSEN2 directions could be located in a direction having any predetermined angular relationship with respect to XRAD and YRAD, and the acceleration components in the XRAD and YRAD directions could be calculated using an equation similar to the one above, substituting in the corresponding constant for the particular angular relationship used.
Referring to
In the configuration of
The angular misalignment with respect to the direction ZRAD is calculated in a substantially similar way. It is desirable that the direction ZRAD be aligned with the direction of gravity, ZCG, at the center of gravity of the motor vehicle 10 when the motor vehicle 10 is parked or traveling on a flat surface. As the vehicle 10 is accelerated in a straight, forward direction, when ZSEN is aligned with ZRAD, and ZSEN is parallel to ZCG in an aligned position, the acceleration measurement along the direction ZSEN should be zero, absent other external factors.
However, the sensor assembly 312 could be misaligned such that the sensor assembly 312 is rotated around the horizontal axis perpendicular to XCG, which is YCG, resulting in the front side 320 of the sensor package 314 tilting upward toward the sky. In other words, the sensor assembly 312 could be rotated along the pitch axis of the vehicle, resulting in vertical misalignment. The inertia sensor 316 is operable to sense this vertical misalignment, because there would be a component of acceleration not equal to zero measured along the axis ZSEN when the motor vehicle 10 is accelerated in a straight-forward path along a flat surface.
The angle of misalignment between the ZRAD sensing direction and the axis ZCG can be calculated by comparing the acceleration component along the ZRAD direction with the acceleration of the vehicle. It should be noted that this relationship is true when the vehicle 10 is being accelerated along a flat surface. If the vehicle 10 is accelerating or decelerating up or down a hill, ZSEN would sense an acceleration component even if properly aligned, as one skilled in the art would appreciate, since the vertical axis of the vehicle 10 would not be aligned with gravity.
With reference to
The signal processing system 22 is configured to receive an acceleration signal from the inertia sensor 16 and calculate an estimated misalignment angle θ between the first axis and a forward axis, the forward axis being parallel to a direction of forward motion XCG of the sensor assembly 12. It should be understood that the signal processing system 22 need not be encased within a single tangible object, but may be any means contemplated by one of ordinary skill in the art to process signals.
Likewise, with reference to
Various methods could be used by the signal processing system 112 for calculating the misalignment angle θ. For example, a statistical way to estimate the misalignment angle θ is the Minimum Mean Square Error Estimator (MMSEE). The following illustrates an equation that could be used to obtain values for θ using the MMSEE:
where θ is the misalignment angle, aXRAD is the acceleration measured in the XRAD direction, and aYRAD is the acceleration measured in the YRAD direction. With reference to
Likewise, the signal processing system 122 could be configured to compensate the sensitive measurement of the forward-looking sensor package 114, based upon the misalignment angle θ. For example, in
Furthermore, a method of detecting angular misalignment of a forward-looking sensor assembly 112 is disclosed. The method includes measuring acceleration along a first axis, the first axis having a fixed relationship with respect to a sensing axis XRAD of a forward-looking sensor package 114 and outputting a first acceleration signal af1. The method also includes determining whether the sensing axis XRAD of the forward-looking sensor package 114 is substantially parallel with a forward axis XCG extending along the direction of forward motion of the forward-looking sensor assembly 112, based on the value of the acceleration signal af1, using a method involving determining the value of the acceleration signal af1 and comparing that value with a predetermined threshold.
The method of misalignment detection contemplated herein could also involve calculating a misalignment angle θ between the forward axis XCG and the sensing axis XRAD of the forward-looking sensor package 114. The misalignment angle θ could then be compared to a predetermined limit. Furthermore, the misalignment angle θ could be compensated for, or an alert signal could be produced, based on the amount that the misalignment angle θ differs from predetermined threshold(s).
The method could alternatively involve measuring acceleration along two axes and using both measurements to calculate a misalignment angle θ between the forward axis XCG and the sensing axis XRAD of the forward-looking sensor package 114, as described above and with reference to
In order to determine misalignment, it is preferable that the sensor assemblies 12, 112, 212, 312 of the present invention be accelerated along a straight, forward path when measuring acceleration with inertia sensors 16, 116, 216, 316. As one having ordinary skill in the art would appreciate, an object accelerating in a non-straight direction has components of acceleration along both a forward axis and an axis pointing toward the center of curvature, which is the centripetal component of acceleration. Therefore, one having ordinary skill in the art would understand that it would be preferable to be able to determine when the motor vehicle 10 is moving in a straight path or a curved path.
Various methods may be used to determine whether the vehicle 10 is moving along a straight path within the spirit of the present invention. For example, the steering wheel angle (SWA) can be determined from the vehicle dynamic control system and compared with a predetermined threshold for a straight steering wheel angle (SWA). Likewise, the speed of the vehicle (determined in a conventional way, such from the ABS or ESP systems) can be multiplied by the yaw rate (determined from the vehicle dynamic control system) and compared to a predetermined threshold for this value, in order to determine whether a vehicle 10 is moving along a straight path. An algorithm may be implemented to compare these criteria and determine whether the vehicle 10 is driving in a straight path.
It is contemplated that such a determination of straight, forward motion may be made by the signal processing system 22, 122 of the present invention in order to provide for an accurate determination of angular misalignment of the sensor assembly 12, 112, 212, 312.
As a person skilled in the art will readily appreciate, the above description is meant as an illustration of the implementation of the principles of this invention. This description is not intended to limit the scope or application of this invention in that the invention is susceptible to modification, variation, and change, without departing from the spirit of this invention, and as defined in the following claims.
Number | Name | Date | Kind |
---|---|---|---|
4166406 | Maughmer | Sep 1979 | A |
4287765 | Kreft | Sep 1981 | A |
5313213 | Neumann et al. | May 1994 | A |
5915275 | Cardarelli et al. | Jun 1999 | A |
5950952 | Koketsu | Sep 1999 | A |
6025797 | Kawai et al. | Feb 2000 | A |
6055841 | Yamada et al. | May 2000 | A |
6107616 | Dauwalter | Aug 2000 | A |
6467349 | Andersson et al. | Oct 2002 | B1 |
6556166 | Searcy et al. | Apr 2003 | B1 |
6651002 | Morgan | Nov 2003 | B1 |
6694277 | Schneider et al. | Feb 2004 | B2 |
6750811 | Asanuma et al. | Jun 2004 | B2 |
6795752 | Zhao et al. | Sep 2004 | B1 |
6895817 | Campbell et al. | May 2005 | B2 |
6900755 | Richardson et al. | May 2005 | B2 |
7299695 | Tanaka et al. | Nov 2007 | B2 |
7613567 | Hashiba | Nov 2009 | B2 |
20020087239 | Kwon | Jul 2002 | A1 |
20030018430 | Ladetto et al. | Jan 2003 | A1 |
20030102178 | Ide et al. | Jun 2003 | A1 |
20040176882 | Fukuda et al. | Sep 2004 | A1 |
20040181329 | Tseng et al. | Sep 2004 | A1 |
20040222902 | Wortsmith | Nov 2004 | A1 |
20050237215 | Hatfield et al. | Oct 2005 | A1 |
20060007002 | Rastegar et al. | Jan 2006 | A1 |
20060080015 | Voeller | Apr 2006 | A1 |
20060293826 | Hong et al. | Dec 2006 | A1 |
20070032951 | Tanenhaus et al. | Feb 2007 | A1 |
20070088477 | Brewer et al. | Apr 2007 | A1 |
Number | Date | Country | |
---|---|---|---|
20080201033 A1 | Aug 2008 | US |