The present invention relates to devices, systems, and methods for testing crash avoidance technologies.
The system disclosed herein can be used with, but is not limited to, vehicles employed in crash avoidance technologies disclosed in the following patent applications developed by the same inventors and assigned to the same assignee: U.S. patent application Ser. No. 14/050039 entitled “System and Method for testing Crash Avoidance Technologies” filed on Oct. 9, 2013 by Joseph Kelly et al; U.S. patent application Ser. No. 14/050048 entitled “System and Method for testing Crash Avoidance Technologies” filed on Oct. 9, 2013 by Joseph Kelly et al; U.S. Patent Application No. 61/874,274 entitled “Master-Slave Automated Coordinated Vehicle Control” filed Sep. 5, 2013 by Joseph Kelly et al; U.S. Patent Application No. 61/874,267 entitled “Rigid Belt Drive Tensioner” filed Sep. 5, 2013 by Joseph Kelly et al; U.S. Patent Application No. 61/874,264 entitled “Robotic Hydraulic Brake Master Cylinder” filed Sep. 5, 2013 by Joseph Kelly et al; U.S. patent application Ser. No. 13/357,526 entitled “System and Method for Testing Crash Avoidance Technologies” filed Jan. 24, 2012 by Joseph Kelly et al (issued as U.S. Pat. No. 8,447,509); U.S. Patent Application No. 61/507,539 entitled “Guided Soft Target For Full Scale Advanced Crash Avoidance Technology Testing” filed on Jul. 13, 2011 by Joseph Kelly et al; U.S. Patent Application No. 61/578,452 entitled “Guided Soft Target For Full Scale Advanced Crash Avoidance Technology Testing” filed on Dec. 21, 2011 filed by Joseph Kelly et al; U.S. Patent Application No. 61/621,597 entitled “Collision Partner, System and Method” filed on Apr. 9, 2012 by Joseph Kelly et al; U.S. Patent Application No. 61/639,745 entitled “Devices, Systems, And Methods For Testing Crash Avoidance Technologies” filed on Apr. 27, 2012 by Joseph Kelly et al; U.S. patent application Ser. No. 13/532,366 entitled “Devices, Systems, And Methods For Testing Crash Avoidance Technologies” filed on Jun. 25, 2012 by Joseph Kelly et al (issued as U.S. Pat. No. 8,428,863); U.S. patent application Ser. No. 13/532,383 entitled “Devices, Systems, And Methods For Testing Crash Avoidance Technologies” filed on Jun. 25, 2012 by Joseph Kelly et al (issued as U.S. Pat. No. 8,428,864); U.S. patent application Ser. No. 13/532,396 entitled “Devices, Systems, And Methods For Testing Crash Avoidance Technologies” filed on Jun. 25, 2012 by Joseph Kelly et al (issued as U.S. Pat. No. 8,457,877); U.S. patent application Ser. No. 13/532,417 entitled “Devices, Systems, And Methods For Testing Crash Avoidance Technologies” filed on Jun. 25, 2012 by Joseph Kelly et al; and U.S. patent application Ser. No. 13/532,430 entitled “Devices, Systems, And Methods For Testing Crash Avoidance Technologies” filed on Jun. 25, 2012 by Joseph Kelly et al. Each of these patent applications is incorporated herein in their entirety including all tables, figures, and claims.
As Advanced Crash Avoidance Technologies (ACATs) such as Forward Collision Warning (FCW), Crash Imminent Braking Systems and other advanced technologies continue to be developed, the need for full-scale test methodologies that can minimize hazards to test personnel and damage to equipment has rapidly increased. Evaluating such ACAT systems presents many challenges. For example, the evaluation system should be able to deliver a potential Soft Collision Partner (Soft CP) reliably and precisely along a trajectory that would ultimately result in a crash in a variety of configurations, such as rear-ends, head-ons, crossing paths, and sideswipes. Additionally, the Soft Collision Partner should not pose a substantial physical risk to the test driver, other test personnel, equipment, or to subject vehicles in the event that the collision is not avoided. This challenge has been difficult to address. Third, the Soft CP should appear to the subject vehicle as the actual item being simulated, such as a motor vehicle, a pedestrian, or other object. For example, the Soft CP should provide a consistent signature for radar and other sensors to the various subject vehicles, substantially identical to that of the item being simulated. It would be also advantageous for the Soft CP to be inexpensive and repeatably reusable with a minimum of time and effort.
As disclosed in the inventors' previous patent applications, fully incorporated herein by reference, the Guided Soft Target (GST) system includes a dynamic motion element (DME) as a mobile and controllable platform that carries the Soft CP. The DME is of such shape and dimension that it can be run over by the vehicle under test (aka the subject vehicle), with little to no damage to either the DME or the subject vehicle. When a collision occurs with the GST system, the subject vehicle impacts the Soft CP, which then absorbs the collision and may collapse. Such a Soft CP is disclosed in U.S. patent application Ser. No. 13/532,366 (issued as U.S. Pat. No. 8,428,863), incorporated by reference. This is disclosed fully in the previous patent applications listed above and incorporated by reference.
The innovations disclosed in this application are directed to systems that guide and control the components of the GST system including the DME, more specifically to closely control the movements of two or more vehicles in coordinated predetermined movements.
A Guided Soft Target System is disclosed that includes a subject vehicle and a dynamic motion element (DME). The subject vehicle may be accelerated at an arbitrary rate to a speed corresponding to the speed in its own predetermined trajectory. Each of the DME vehicles computes its target speed as a ratio of the subject vehicle's speed at each waypoint location, and modulates its speed control to achieve this target speed. To further compensate for timing differences along the target path, each DME computes its longitudinal error along the path relative to its target position, as dictated by the position of the subject vehicle within its own trajectory, and each DME's target speed is modulated in order to minimize the longitudinal error along the predetermined trajectory.
Other aspects of the invention are disclosed herein as discussed in the following Drawings and Detailed Description.
The invention can be better understood with reference to the following figures. The components within the figures are not necessarily to scale, emphasis instead being placed on clearly illustrating example aspects of the invention. In the figures, like reference numerals designate corresponding parts throughout the different views. It will be understood that certain components and details may not appear in the figures to assist in more clearly describing the invention.
Following is a non-limiting written description of example embodiments illustrating various aspects of the invention. These examples are provided to enable a person of ordinary skill in the art to practice the full scope of the invention without having to engage in an undue amount of experimentation. As will be apparent to persons skilled in the art, further modifications and adaptations can be made without departing from the spirit and scope of the invention, which is limited only by the claims.
As disclosed in patent application Ser. No. 13/357,526 incorporated herein by reference, an example GST system architecture and functions are disclosed. GST systems in various example embodiments may comprise, for instance, a plurality of computers that communicate, for instance via a Wireless Local Area Network (WLAN), and perform various functions.
The computer associated with the subject vehicle 105 may perform the various data I/O functions within the subject vehicle 105, and provide the measured data to the rest of the system. Additionally, the subject computer may control discrete events within the subject vehicle 105. The subject vehicle 105 node may comprise the following components, for example: notebook computer; differential GPS (DGPS) receiver; tri-axial accelerometer; digital I/O board to monitor and control discrete events (e.g., sense ACAT warning on/off, illuminate LEDs, initiate open-loop braking, provide audible alerts); and wireless LAN bridge, for instance.
The base station 110 may act as the central hub for all communications and allow the operator to monitor and control the system. The base station 110 may comprise the following components, for example: DGPS base station receiver; notebook computer; joystick; wireless LAN router; and radio transmitter to provide emergency-stop capability, for instance.
The computer associated with the base station 110 may allow the system operator to run a complete suite of tests from a single location. From the computer associated with the base station 110, the operator may perform the following functions, for example: setup and configuration of subject vehicle 105 and GST computers via remote connection; monitor subject vehicle 105 and GST positions, speeds, system health information and other system information; setup of test configuration; test coordination; post-test data analysis; and selection of GST modes, including, for example: hold; manual; semi-autonomous; and fully autonomous, for instance. Additionally, the functions of the computer associated with the base station 110 may also be accomplished on the computer associated with the subject vehicle 105, reducing the number of computers in the computer network. In this embodiment of a GST, the base station, or operator's console would be located in the subject vehicle 105. The methods used for subject vehicle 105 and DME 115 control and positioning are described below with reference to
The DGPS receiver in the base station 110 may provide corrections to the roving DGPS receivers in both the DME 115 and the subject vehicle 105 via a WLAN or other communications network. This may be accomplished without the need for a separate DGPS radio modem, minimizing the number of antennas on each node of the system. This may be important in the case of the DME 115, since all connections to antennas are typically made frangible, such that they can separate from the DME 115 in the event of a collision with the subject vehicle 105.
Example DME 115 subsystems may comprise the following components, among others, for instance: wireless LAN bridge; PC104 computer; yaw rate sensor; electronic compass; two brushless DC drive motors and amplifiers; a brushless DC steering motor and amplifier; brake system; RF emergency brake system; DGPS receiver; a DME computer such as a PC104 computer that performs functions such as the following example functions: Guidance, Navigation and Control (GNC) computations; analog and digital data input and output; inputs, including: differential GPS information; electronic compass (heading angle); yaw rate; drive motor speed; steering angle; drive motor amplifier temperature; drive motor winding temperature; and outputs, including: drive motor torque command; steer motor angle command; brake command; system health monitoring; and data collection, for instance. Other or fewer components may be used in various example embodiments.
Prior to testing, paired time-space trajectories for the subject vehicle 105 and DME 115 (preferably loaded with a soft CP) may be generated. For example,
One embodiment of a trajectory file is an ASCII file with a format as depicted in Table 1 below. The files may include some basic header information and a set of data for each waypoint. Each line in the file defines a waypoint and various data associated with such waypoint. A waypoint is a point in space along the vehicle's path. Each subject vehicle waypoint corresponds to a DME waypoint such that, when the subject vehicle is at waypoint 10, for example, the DME should also be at its waypoint 10. The trajectory file may also consist of other data such as the speed ratio (SR) (ratio of this vehicles speed to the other vehicle) and the speed (Spd).
Each vehicle in the test would have its own trajectory file. Alternatively, the GST system 100 may implement a single trajectory file with position and speed data for each vehicle at each waypoint.
The GST system 100 may use a trajectory file that causes a collision between the subject vehicle 105 and DME 115, as shown in
These trajectories should be physics-based, and either can be hypothetical or reconstructed real-world crash scenarios. Trajectories can be specified to result in no collision, or any manner of collision between the subject vehicle 105 and DME 115, and can include variations in speed and path curvature for both the subject vehicle 105 and DME 115. The spatial trajectories may be stored in files which also include subject vehicle 105 and DME 115 speeds along their respective paths, and scenario-specific discrete events. These discrete events (e.g., point of brake application) can be used to control the timing of events in the subject vehicle 105 at known points along the subject vehicle 105 path. These can be used to initiate open-loop braking, illuminate LEDs, or provide audible alerts within the subject vehicle 105, for example.
In various embodiments a GST system 100 may have, for instance, four different modes of operation: hold; manual; semi-autonomous; and fully-autonomous. The Hold Mode is the “idle” mode for the GST system. In this mode, the output signals to the steering and drive motors may be nullified, but the GUI for the base station 110 may continue to show data from the DME 115 and subject vehicle 105 sensors. Whenever the DME 115 is switched into this mode from one of the “active” modes (e.g., Manual, Semi-Autonomous or Fully Autonomous), data that was collected during the active mode may be transferred wirelessly to the computer associated with the base station 110 for further analysis.
The Manual Mode may be completely human-controlled via a joystick associated with the base station 110. In this mode, the operator may have remote control over the speed and steering of the DME 115. This mode may be useful in pre-positioning the DME 115 or for returning it to base for charging the batteries, routine service, or for shutting down the system.
The Semi-Autonomous Mode allows the operator of the base station 110 to control the speed of the DME 115 while the path following may be accomplished autonomously. This may be especially useful for pre-positioning the DME 115 before a given test run, since the DME 115 can be driven starting from any point on the test surface, and it will seek and converge on the desired path. The path-following GNC algorithm also may allow for operation in reverse, allowing the operator to drive the DME 115 in reverse along the path for fast repetition of tests.
The Fully Autonomous Mode may require no further inputs from the base station 110. In this mode, the subject vehicle 105 may be driven along the subject vehicle 105 path, and the DME 115 computes the speed and steering inputs necessary to move along its own path in coordination with the subject vehicle 105, as determined by the pre-programmed trajectory pair. In this way, the longitudinal position of the DME 115 may be driven by the longitudinal position of the subject vehicle 105 such that the DME 115 arrives at the pre-determined collision point at the same moment as the subject vehicle 105, even accommodating errors in the speed of the subject vehicle 105 (relative to the speed in the trajectory file) as it approaches by adjusting its own speed. As an option, the test engineer can enable a sub-mode in which, if the subject vehicle 105 driver or ACAT system begins to react to the impending collision, the DME 115 speed command may be switched to the speed contained in the trajectory file such that it is no longer dependent upon the speed of the subject vehicle 105. The switch to this sub-mode may be made automatically (mid-run) when the subject vehicle 105 acceleration exceeds a predetermined threshold (e.g., 0.3 g) or when subject vehicle 105 ACAT system activation may be sensed via a discrete input. In this way, the DME 115 passes through the would-be collision point at the speed prescribed in the trajectory file, irrespective of the position or speed of the subject vehicle 105.
During test setup, the paired time-space trajectories may be wirelessly loaded into the DME 115 on-board processor from the base station 110, and the DME 115 may be placed into the fully autonomous mode. As the subject vehicle 105 begins to travel along its path, its position (as measured by DGPS) may be transmitted wirelessly to the DME 115 processor, which may be programmed to accomplish lateral and longitudinal control to obtain the desired relative closed-loop trajectories. A given test run can culminate in a collision between the subject vehicle 105 and the DME 115, in which case, the DME 115 may be brought to a stop using a radio transmitter, separate from the WLAN, which can actuate the onboard brakes of the DME 115, and disable the drive motors. Test data may be automatically transmitted wirelessly from the DME 115 to the computer associated with the base station 110 once the operator transitions from the Fully Autonomous mode to the Hold mode.
The DME 115 may employ high-performance and high-efficiency components, allowing it to reach relatively high speeds and achieve high positional accuracy along its trajectory. Brushless DC drive motors efficiently deliver high power from a small package, and a DGPS receiver provides high positional accuracy.
Each vehicle (i.e., the DME 110 and the subject vehicle 105) is equipped with sensing technology allowing it to determine at least its position, its orientation and its velocity with respect to some known coordinate system. This sensing technology may consist of DGPS or any other position measurement system. The sensor optionally may be integrated with an Inertial Measurement Unit (IMU) which improves the accuracy of the sensed signals. Speed signals can be measured from GPS, an IMU, or an independent speed sensor (such as a Doppler or optical speed sensor).
Each DME is equipped with means to regulate its lateral path deviation (e.g., through means of automatic steering) and to regulate its speed along its predetermined path (e.g., through means of automatic speed control—motor, engine, brake, etc.).
The subject vehicle is equipped with a means of broadcasting its own position, speed and orientation, such that the GST System 100 can determine where the subject vehicle is along the predetermined subject vehicle path. This can be done by any means, including Wireless Local Area Network (LAN), Controller Area Network (CAN) or any other wired or wireless means of data transmission.
The subject vehicle can be manually operated by a human operator, or can be automatically or autonomously controlled to move along the intended path at varying speed. All vehicles are initially positioned at or near starting locations corresponding to positions within, or extrapolated from the predetermined trajectories. The subject vehicle is accelerated at an arbitrary rate to a speed corresponding to the speed in its own predetermined trajectory. Each of the DME vehicles (there can be more than one) computes its target speed as a ratio of the subject vehicle's speed at each waypoint location, and modulates its speed control to achieve this target speed. To further compensate for timing differences along the target path, each DME computes its longitudinal error along the path relative to its target position, as dictated by the position of the subject vehicle within its own trajectory, and each DME's target speed is modulated in order to minimize the longitudinal error along the predetermined trajectory.
Turning now to
Method 300 begins by determining the position of the subject vehicle and DME in steps 305 and 310 (this can be done by GPS measurements). The DME position 310 is used to calculate the position of the DME within the DME trajectory file 315, as shown in step 320. In step 330 a similar calculation is done for the subject vehicle within the subject vehicle trajectory file 325. Both the subject vehicle and DME trajectory files may be consolidated into a single file. At step 335, the method 300 uses the position of the subject vehicle within the trajectory file from step 330 to find the target position of the DME within the DME trajectory file. Recall that the trajectory files have discrete waypoints at simultaneous times, therefore knowing where the subject vehicle is along its trajectory, the method 300 can calculate where the DME should be according to the DME trajectory file.
DME's measured (or actual) distance is determined along the trajectory file at step 340. The difference between the two values of steps 335 and 340 calculated at step 342 would represent a distance deviation (i.e., the longitudinal error) from the programmed trajectory of the DME which, in turn, would prevent the collision from occurring at the expected conditions (i.e., position, speed, location of impact on the vehicle).
The method 300 must therefore compensate the speed of the DME to regulate this error, which is done at step 345. This speed compensation is added to a “feed-forward” speed, calculated in step 355, in order to determine the actual desired speed of the DME in step 365. The“feed-forward” speed is an estimate of the required speed of the DME to achieve the desired longitudinal control without any feedback from the DME (i.e., open-loop control). The “feed-forward” speed accounts for the current actual speed of the subject vehicle at step 350, by determining the speed ratio from the trajectory file for the DME at the current position. For example, at the current position the subject vehicle should be traveling at 60 KPH while the DME is to travel at 30 KPH. The speed ratio is therefore 2:1, or the DME travels at 0.5 the speed of the subject vehicle. At step 355, the method uses the subject vehicle speed 360 to determine a “feed-forward” speed. For example, if the subject vehicle is traveling 20% faster than it should, at this waypoint, the “feed-forward” speed would be: 72 KPH (speed of subject vehicle)×0.5 (speed ratio)=36 KPH. Therefore, a component of the speed command to the DME is generated by the speed ratio applied to the measured speed of the subject vehicle.
The “feed-forward” speed and the speed compensation based on the error in distance (i.e., step 345) are combined at step 365 to calculate a new DME speed. The new instructions for the speed controller are calculated at step 370, which relies in part on the current speed of the DME 375. If for example, the commanded speed is 36 KPH and the current DME speed is only 30 KPH, then the system would know that it is far from the needed speed and might create an instruction for the controller to accelerate at a high rate to get to the target speed as fast as possible. If, however, the difference is only 0.5 KPH, the acceleration in the controller instruction might be less. This may be accomplished using, for example, a Proportional/Integral (PI) feedback control to regulate and minimize the error.
The above description has been limited to a two vehicle scenario. However, it would be apparent to those in the art that these teaching can be used to control more than two vehicles. For example, the test scenario may require two DMEs to collide with the subject vehicle. In such a case, each vehicle would have its own trajectory file, and the speed and position of each vehicle can be controlled by the method 300 described above. The GST System 100 would run the method 300 for the second DME as it did for the first, keeping the second vehicle as true to the trajectory as possible.
As will be apparent to persons skilled in the art, modifications and adaptations to the above-described example embodiments of the invention can be made without departing from the spirit and scope of the invention, which is defined only by the following claims.
The present invention is a continuation patent application of U.S. patent application Ser. No. 14/062,287, filed Oct. 24, 2013, which claims benefit of U.S. Provisional Application No. 61/874,274, filed Sep. 5, 2013, and claims benefit of U.S. Provisional Application No. 61/874,267, filed Sep. 5, 2013, and claims benefit of U.S. Provisional Application No. 61/874,264, filed Sep. 5, 2013, and which is a continuation-in-part application of U.S. patent application Ser. No. 13/532,417, filed Jun. 25, 2012, now U.S. Pat. No. 8,583,358, issued Nov. 12, 2013, and which is a continuation-in-part application of U.S. patent application Ser. No. 13/532,430, filed Jun. 25, 2012, now U.S. Pat. No. 8,589,062, issued Nov. 19, 2013, which claims benefit of U.S. Provisional Application No. 61/507,539, filed Jul. 13, 2011, and claims benefit of U.S. Provisional Application No. 61/578,452, filed Dec. 21, 2011; and which is a continuation-in-part application of U.S. patent application Ser. No. 13/357,526, filed Jan. 24, 2012, now U.S. Pat. No. 8,447,509, issued May 21, 2013; and which claims benefit of U.S. Provisional Application No. 61/621,597, filed Apr. 9, 2012, and which claims benefit of U.S. Provisional Application No. 61/639,745, filed Apr. 27, 2012; all of which are hereby incorporated in their entirety including all tables, figures and claims. U.S. patent application Ser. No. 14/062,287 is also a continuation-in-part of U.S. patent application Ser. No. 14/050,039, filed Oct. 9, 2013, and is a continuation-in-part application of U.S. patent application Ser. No. 14/050,048, filed Oct. 9, 2013, all of which are hereby incorporated in their entirety including all tables, figures and claims.
Number | Date | Country | |
---|---|---|---|
61874274 | Sep 2013 | US | |
61874267 | Sep 2013 | US | |
61874264 | Sep 2013 | US | |
61507539 | Jul 2011 | US | |
61578452 | Dec 2011 | US | |
61621597 | Apr 2012 | US | |
61639745 | Apr 2012 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 14062287 | Oct 2013 | US |
Child | 14207892 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 13532417 | Jun 2012 | US |
Child | 14062287 | US | |
Parent | 13532430 | Jun 2012 | US |
Child | 13532417 | US | |
Parent | 13357526 | Jan 2012 | US |
Child | 13532430 | US | |
Parent | 14050039 | Oct 2013 | US |
Child | 14062287 | US | |
Parent | 14050048 | Oct 2013 | US |
Child | 14050039 | US |