The present application is related to U.S. application Ser. No. 15/044,851 filed on Feb. 16, 2016 entitled Preview Lateral Control for Automated Driving and U.S. application Ser. No. 15/621,242 filed on Jun. 13, 2017 entitled System and Method for Low Speed Lateral Control of a Vehicle.
Apparatuses and methods consistent with exemplary embodiments relate to controlling vehicles. More particularly, apparatuses and methods consistent with exemplary embodiments relate to controlling vehicle during automated backward motion.
One or more exemplary embodiments provide a method and an apparatus that control lateral movement of a vehicle during backward motion. In particular, one or more exemplary embodiments control lateral movement of an autonomous vehicle during backward movement by reflecting waypoints of a reverse or backward path over an axis that delineates forward and backward movement to generate a virtual forward path including the reflected waypoints. The lateral movement of the vehicle is then controlled by adjusting road wheel angle so as to the direct only the lateral movement of the vehicle toward the reflected waypoints of the virtual forward path.
According to an aspect of exemplary embodiment, a method that controls lateral movement of a vehicle during backward motion is provided. The method includes loading a desired backward path of vehicle, the backward path including waypoints to be traveled along during a rearward motion of the vehicle, reflecting the waypoints along a reflection axis perpendicular to a longitudinal axis that runs from front to back of the vehicle such that the reflected waypoints define virtual forward path, and controlling lateral movement of the vehicle to follow the waypoints along the virtual forward path while the vehicle is traveling in a backward direction.
The controlling lateral movement of the vehicle may include performing one-dimensional nonlinear optimization to determine a road wheel angle corresponding to the virtual forward path by minimizing lateral deviation of a center of gravity of the vehicle from the virtual forward path.
The may also include outputting the determined road wheel angle command to a front wheel actuator to turn the front wheel of the vehicle while the vehicle is traveling in the backward direction.
The outputting the determined road wheel angle command to the front wheel actuator may also include determining a current road wheel angle and outputting the road wheel angle command based on a difference between the current road wheel angle and the determined road wheel angle.
The controlling the lateral movement of the vehicle may include minimizing a cost function corresponding to a difference between waypoints representing the virtual forward path of the vehicle and a reflection of coordinates corresponding to an estimated position of the vehicle.
The determined road wheel angle command may be a product of a function of a speed of the vehicle and a road wheel angle which minimizes the cost function.
The method may also include detecting that the vehicle is in reverse mode and, in response to detecting the vehicle in reverse mode, loading the desired backward path of the vehicle.
The vehicle may include traveling in a backward direction at a speed below thirty-five miles per hour.
The reflection axis may intersect one from among a center of the vehicle, a center of gravity of the vehicle, front wheels of the vehicle or rear wheels of the vehicle.
According to an aspect of an exemplary embodiment, an apparatus that controls lateral movement of a vehicle during backward motion is provided. The apparatus includes: at least one memory comprising computer executable instructions; and at least one processor configured to read and execute the computer executable instructions. The computer executable instructions cause the at least one processor to load a desired backward path of vehicle, the backward path including waypoints to be traveled along during a rearward motion of the vehicle, reflect the waypoints along a reflection axis perpendicular to a longitudinal axis that runs from front to back of the vehicle such that the reflected waypoints define virtual forward path, and control lateral movement of the vehicle to follow the waypoints along the virtual forward path while the vehicle is traveling in a backward direction.
The computer executable instructions may cause the at least one processor to control the lateral movement of the vehicle by performing one-dimensional nonlinear optimization to determine a road wheel angle corresponding to the virtual forward path by minimizing lateral deviation of a center of gravity of the vehicle from the virtual forward path.
The computer executable instructions may cause the at least one processor to output the determined road wheel angle command to a front wheel actuator to turn the front wheel of the vehicle while the vehicle is traveling in the backward direction.
The computer executable instructions may cause the at least one processor to output the determined road wheel angle command to the front wheel actuator by determining a current road wheel angle and outputting the road wheel angle command based on a difference between the current road wheel angle and the determined road wheel angle.
The computer executable instructions may cause the at least one processor to control the lateral movement of the vehicle by minimizing a cost function corresponding to a difference between waypoints representing the virtual forward path of the vehicle and a reflection of coordinates corresponding to an estimated position of the vehicle.
The determined road wheel angle command may be a product of a function of a speed of the vehicle and a road wheel angle which minimizes the cost function.
The computer executable instructions may cause the at least one processor to detect that the vehicle is in reverse mode and, in response to detecting the vehicle in reverse mode, load the desired backward path of the vehicle.
The vehicle may be traveling in a backward direction at a speed below thirty-five miles per hour.
The reflection axis may intersect one from among a center of the vehicle, a center of gravity of the vehicle, front wheels of the vehicle or rear wheels of the vehicle. the axes are centered at one from among front wheels of the vehicle, rear wheels of the vehicle, and a center of gravity of the vehicle.
Other objects, advantages and novel features of the exemplary embodiments will become more apparent from the following detailed description of exemplary embodiments and the accompanying drawings.
An apparatus and method that control lateral movement of the vehicle during backward motion will now be described in detail with reference to
The following disclosure will enable one skilled in the art to practice the inventive concept. However, the exemplary embodiments disclosed herein are merely exemplary and do not limit the inventive concept to exemplary embodiments described herein. Moreover, descriptions of features or aspects of each exemplary embodiment should typically be considered as available for aspects of other exemplary embodiments.
It is also understood that where it is stated herein that a first element is “connected to,” “attached to,” “formed on,” or “disposed on” a second element, the first element may be connected directly to, formed directly on or disposed directly on the second element or there may be intervening elements between the first element and the second element, unless it is stated that a first element is “directly” connected to, attached to, formed on, or disposed on the second element. In addition, if a first element is configured to “send” or “receive” information from a second element, the first element may send or receive the information directly to or from the second element, send or receive the information via a bus, send or receive the information via a network, or send or receive the information via intermediate elements, unless the first element is indicated to send or receive information “directly” to or from the second element.
Throughout the disclosure, one or more of the elements disclosed may be combined into a single device or into one or more devices. In addition, individual elements may be provided on separate devices.
Vehicles are becoming increasingly automated and capable of performing maneuvers or driving themselves under controlled circumstances. A vehicle path including waypoints may define a desired path or maneuver and be used to control actuators to adjust the road wheel angle so that the path of travel of the vehicle is as close to the desired path as possible. However, backward paths and reverse maneuvers may be more complex and difficult to execute. Examples of backward paths and complex reverse maneuvers may include backing out of driveways onto streets, backing out in case of an unexpectedly closed road, or parallel, perpendicular and/or angled parking, with capability to react to dynamic obstacles behind the vehicle.
When controlling the vehicle to follow a backward path via reverse motion, the complexities arise because the system will have a greater phase contribution, e.g., vehicle moves away from the path before it moves closer to the path. Thus, a control system to address this complexity may help simplify vehicle maneuvering and more closely follow a backward path for reverse motion speeds under 35 miles per hour.
The controller 101 controls the overall operation and function of the apparatus that controls lateral movement of the vehicle during backward motion 100. The controller 101 may control one or more of a storage 103, an output 104, vehicle settings and controls 105, a user input 106, a sensor 107 and a communication device 108 of the apparatus that controls lateral movement of the vehicle during backward motion 100. The controller 101 may include one or more from among a processor, a microprocessor, a central processing unit (CPU), a graphics processor, Application Specific Integrated Circuits (ASICs), Field-Programmable Gate Arrays (FPGAs), state machines, circuitry, and a combination of hardware, software and firmware components.
The controller 101 is configured to send and/or receive information from one or more of the storage 103, the output 104, the vehicle settings and controls 105, the user input 106, the sensor 107 and the communication device 108 of the apparatus that controls lateral movement of the vehicle during backward motion 100. The information may be sent and received via a bus or network, or may be directly read or written to/from one or more of the storage 103, the output 104, the vehicle settings and controls 105, the user input 106, the sensor 107 and the communication device 108 of the apparatus that controls lateral movement of the vehicle during backward motion 100. Examples of suitable network connections include a controller area network (CAN), a media oriented system transfer (MOST), a local interconnection network (LIN), a local area network (LAN), wireless networks such as Bluetooth and 802.11, and other appropriate connections such as Ethernet.
The power supply 102 provides power to one or more of the controller 101, the storage 103, the output 104, the vehicle settings and controls 105, the user input 106, the sensor 107 and the communication device 108, of the apparatus that controls lateral movement of the vehicle during backward motion 100. The power supply 102 may include one or more from among a battery, an outlet, a capacitor, a solar energy cell, a generator, a wind energy device, an alternator, etc.
The storage 103 is configured for storing information and retrieving information used by the apparatus that controls lateral movement of the vehicle during backward motion 100. The storage 103 may be controlled by the controller 101 to store and retrieve information including desired path information, virtual forward path information, road wheel angle information, vehicle dynamics information, and estimated position information. The information may be collected and received the from user input 106, the communication device 108 or from one or more of the sensors 107. The storage 103 may also include the computer instructions configured to be executed by a processor to perform the functions of the apparatus that controls lateral movement of the vehicle during backward motion 100.
The path information may include waypoints including an x coordinate and a y coordinate. The x coordinate is a coordinate with respect to an axis that runs longitudinally (i.e. front to back of the vehicle) through a center of a vehicle or center of mass of the vehicle. The y coordinate is a coordinate with respect to an axis that runs perpendicular to the longitudinal axis thorough a center of the vehicle or the center of center of mass of the vehicle. The center or center of mass of the vehicle are only examples of where the axes may intersect and the axes may be centered at the front wheel or rear wheels of the vehicle. The waypoints may make up a forward path or a backward path.
The road wheel angle information may include the angle of the wheels and/or direction of travel of the vehicle. The estimated position information may include the present location of the vehicle (e.g., the center of gravity of the vehicle, the center of the vehicle, the front wheels of the vehicle or the rear wheels of the vehicle) or predicted or estimated position, and may include GPS coordinates and/or offset information. The road wheel angle information may be provided by sensors 107 or reading information provided by the vehicle settings and controls 105.
The vehicle dynamics information may include one or more from among lateral acceleration, longitudinal acceleration, speed information, steering angle information, or road wheel angle information. The vehicle dynamics information may be provided by sensors 107 or reading information provided by the vehicle settings and controls 105.
The storage 103 may include one or more from among floppy diskettes, optical disks, CD-ROMs (Compact Disc-Read Only Memories), magneto-optical disks, ROMs (Read Only Memories), RAMs (Random Access Memories), EPROMs (Erasable Programmable Read Only Memories), EEPROMs (Electrically Erasable Programmable Read Only Memories), magnetic or optical cards, flash memory, cache memory, and other type of media/machine-readable medium suitable for storing machine-executable instructions.
The output 104 outputs information in one or more forms including: visual, audible and/or haptic form. The output 104 may be controlled by the controller 101 to provide outputs to the user of the apparatus that controls lateral movement of the vehicle during backward motion 100. The output 104 may include one or more from among a speaker, audio, a display, a centrally-located display, a head up display, a windshield display, a haptic feedback device, a vibration device, a tactile feedback device, a tap-feedback device, a holographic display, an instrument light, an indicator light, etc.
The output 104 may output notification including one or more from among an audible notification, a light notification, and a display notification. The notification may include information notifying of a value of a vehicle setting or notifying that a vehicle setting is being adjusted. In addition, the output 104 may display a message for a person at an appropriate location in the vehicle.
The vehicle settings and controls 105 may include vehicle system modules (VSMs) in the form of electronic hardware components that are located throughout the vehicle and typically receive input from one or more sensors and use the sensed input to perform diagnostic, monitoring, control, reporting and/or other functions. Each of the VSMs may be connected by a communications bus to the other VSMs, as well as to the controller 101, and can be programmed to run vehicle system and subsystem diagnostic tests. The controller 101 may be configured to send and receive information from the VSMs and to control VSMs to perform vehicle functions.
As examples, one VSM can be an engine control module (ECM) that controls various aspects of engine operation such as fuel ignition and ignition timing, another VSM can be an external sensor module configured to receive information from external sensors such as cameras, radars, LIDARs, and lasers, another VSM may be electronic power steering module that controls steering angle, another VSM can be a powertrain control module that regulates operation of one or more components of the vehicle powertrain, another VSM can be the vehicle dynamics sensor that detects a steering wheel angle parameter, a speed parameter, an acceleration parameter, a lateral acceleration parameter, and/or a road wheel angle parameter, and another VSM can be a body control module that governs various electrical components located throughout the vehicle, like the vehicle's power door locks and headlights. As is appreciated by those skilled in the art, the above-mentioned VSMs are only examples of some of the modules that may be used in a vehicle, as numerous others are also available.
The user input 106 is configured to provide information and commands to the apparatus that controls lateral movement of the vehicle during backward motion 100. The user input 106 may be used to provide user inputs, etc., to the controller 101. The user input 106 may include one or more from among a touchscreen, a keyboard, a soft keypad, a button, a motion detector, a voice input detector, a microphone, a camera, a trackpad, a mouse, a touchpad, etc.
The user input 106 may be configured to receive a user input to acknowledge or dismiss the notification output by the output 104. The user input 106 may also be configured to receive a user input to adjust a vehicle setting. The adjusted vehicle setting may then be stored in storage 103.
The sensor 107 may include one or more sensors from a camera, an infrared thermal camera, an accelerometer, a barometer, an elevation sensor, a light sensor, an altimeter, a speedometer, a gyroscope, and a braking pressure sensor. In one example, the camera may be one or more from among an in-vehicle camera, an infrared camera, and a mobile device camera.
The communication device 108 may be used by apparatus that controls lateral movement of the vehicle during backward motion 100 to communicate with several types of external apparatuses according to various communication methods. The communication device 108 may be used to send/receive information from a mobile device. The communication device 108 may send information and notifications to be output by the mobile device by an output at the mobile device that performs functions similar to output 104.
The communication device 108 may include various communication modules such as one or more from among a telematics unit, a broadcast receiving module, a near field communication (NFC) module, a GPS receiver, a wired communication module, or a wireless communication module. The broadcast receiving module may include a terrestrial broadcast receiving module including an antenna to receive a terrestrial broadcast signal, a demodulator, and an equalizer, etc. The NFC module is a module that communicates with an external apparatus located at a nearby distance according to an NFC method. The GPS receiver is a module that receives a GPS signal from GPS satellites and detects a current location. The wired communication module may be a module that receives information over a wired network such as a local area network, a controller area network (CAN), or an external network. The wireless communication module is a module that is connected to an external network by using a wireless communication protocol such as IEEE 802.11 protocols, WiMAX, Wi-Fi or IEEE communication protocol and communicates with the external network. The wireless communication module may further include a mobile communication module that accesses a mobile communication network and performs communication according to various mobile communication standards such as 3rd generation (3G), 3rd generation partnership project (3GPP), long-term evolution (LTE), Bluetooth, EVDO, CDMA, GPRS, EDGE or ZigBee.
According to an exemplary embodiment, the controller 101 of the apparatus that controls lateral movement of the vehicle during backward motion 100 may be configured to load a desired backward path of vehicle, the backward path including waypoints to be traveled along during a rearward motion of the vehicle, reflect the waypoints along a reflection axis perpendicular to a longitudinal axis that runs from front to back of the vehicle such that the reflected waypoints define virtual forward path, and control lateral movement of the vehicle to follow the waypoints along the virtual forward path while the vehicle is traveling in a backward direction.
The controller 101 may load the desired backward path of the vehicle in response to detecting that the vehicle is in reverse mode. The vehicle may travel in a backward direction at a speed below thirty-five miles per hour. The reflection axis may intersect a center of the vehicle, a center of gravity of the vehicle, front wheels of the vehicle or rear wheels of the vehicle. The longitudinal and reflection axes may be centered at one from among front wheels of the vehicle, rear wheels of the vehicle, and a center of gravity of the vehicle.
In addition, the controller 101 of the apparatus that controls lateral movement of the vehicle during backward motion 100 may also be configured to control the lateral movement of the vehicle by performing one-dimensional nonlinear optimization to determine a road wheel angle corresponding to the virtual forward path by minimizing lateral deviation of a center of gravity of the vehicle from the virtual forward path.
Further, the controller 101 of the apparatus that controls lateral movement of the vehicle during backward motion 100 may be configured to output the determined road wheel angle command to a front wheel actuator to turn the front wheel of the vehicle while the vehicle is traveling in the backward direction.
In addition, the controller 101 of the apparatus that controls lateral movement of the vehicle during backward motion 100 may be configured to control to output the determined road wheel angle command to a front wheel actuator to turn the front wheel of the vehicle while the vehicle is traveling in the backward direction.
The controller 101 may control to output the determined road wheel angle command to the front wheel actuator by determining a current road wheel angle and outputting the road wheel angle command based on a difference between the current road wheel angle and the determined road wheel angle. The determined road wheel angle command may be a product of a function of a speed of the vehicle and the minimized cost function.
The controller 101 may control the lateral movement of the vehicle by minimizing a cost function corresponding to a difference between waypoints representing the virtual forward path of the vehicle and a reflection of coordinates corresponding to an estimated position of the vehicle.
The road wheel angle or lateral movement of the vehicle needs to be controlled to direct the lateral movement of vehicle 201 towards waypoints 203 along desired path 202. To reduce the complexity of this process, the waypoints of desired path 202 are reflected across axis 205 to create an imaginary reflected virtual forward path 204. The road wheel angle or lateral movement of the vehicle is controlled so as to follow the reflected virtual forward path 204 while the vehicle is traveling backwards.
In other words, the estimated actual or current position of the vehicle is captured as the vehicle is traveling in reverse and the estimated actual or current position is then reflected over the axis perpendicular to the longitudinal axis of the vehicle. The reflected estimated current position is then used to adjust the lateral movement or road wheel angle of the vehicle to direct the vehicle towards the next waypoint on the virtual forward path 204. However, the vehicle continues its motion in reverse or backwards.
Referring to
The lateral movement of the vehicle is controlled in operation S330 to follow waypoints along forward path while vehicle is traveling backward. In one example, the lateral movement may be controlled by outputting the determined road wheel angle command to a front wheel actuator by determining a current road wheel angle and outputting the road wheel angle command based on a difference between the current road wheel angle and a determined or target road wheel angle.
The processes, methods, or algorithms disclosed herein can be deliverable to/implemented by a processing device, controller, or computer, which can include any existing programmable electronic control device or dedicated electronic control device. Similarly, the processes, methods, or algorithms can be stored as data and instructions executable by a controller or computer in many forms including, but not limited to, information permanently stored on non-writable storage media such as ROM devices and information alterably stored on writeable storage media such as floppy disks, magnetic tapes, CDs, RAM devices, and other magnetic and optical media. The processes, methods, or algorithms can also be implemented in a software executable object. Alternatively, the processes, methods, or algorithms can be embodied in whole or in part using suitable hardware components, such as Application Specific Integrated Circuits (ASICs), Field-Programmable Gate Arrays (FPGAs), state machines, controllers or other hardware components or devices, or a combination of hardware, software and firmware components.
One or more exemplary embodiments have been described above with reference to the drawings. The exemplary embodiments described above should be considered in a descriptive sense only and not for purposes of limitation. Moreover, the exemplary embodiments may be modified without departing from the spirit and scope of the inventive concept, which is defined by the following claims.
Number | Name | Date | Kind |
---|---|---|---|
8199987 | Caryer Cook | Jun 2012 | B2 |
20050049766 | Tanaka et al. | Mar 2005 | A1 |
20050273236 | Mori et al. | Dec 2005 | A1 |
20090279774 | Cook | Nov 2009 | A1 |
20120185113 | Pampus | Jul 2012 | A1 |
20140365108 | You | Dec 2014 | A1 |
20160153791 | Deittert | Jun 2016 | A1 |
20170233001 | Moshchuk et al. | Aug 2017 | A1 |
20180297589 | Hasejima | Oct 2018 | A1 |
20190101925 | Simmons | Apr 2019 | A1 |
20200122717 | Kim | Apr 2020 | A1 |
Number | Date | Country | |
---|---|---|---|
20200156694 A1 | May 2020 | US |