# US 2021/0197822 A1 · Trajectory planning method for lane changing, and driver assistance system for implementing the same

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2021/0197822 A1
- Document ID: US20210197822A1
- Status: Published application
- Kind: A1
- Application number: 16/729,895
- Filed: 2019-12-30
- Published: 2021-07-01
- Earliest claimed: 2019-12-30
- Assignees: Automotive Research & Testing Center
- Applicants: Automotive Research & Testing Center
- Inventors: Tong-Kai JHANG; Chien-Hung YU; Jin-Yan HSU; Kun-Lung KU
- Web page: https://patentgrep.com/patent/US20210197822A1

## CPC

- B60W 30/18163: {Lane change; Overtaking manoeuvres}
- B60W 30/0953: {the prediction being responsive to vehicle dynamic parameters}
- B60W 30/12: Lane keeping
- B60W 40/107: Longitudinal acceleration
- B60W 40/109: Lateral acceleration
- G05D 1/027: {comprising intertial navigation means, e.g. azimuth detector (inertial navigation G01C21/16; inertial navigation combined with non-inertial navigation instruments G01C21/165)}
- G05D 1/0891: {specially adapted for land vehicles}
- G06V 20/588: {Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road}
- B60W 2520/10: Longitudinal speed
- B60W 2520/12: Lateral speed
- B60W 2520/125: Lateral acceleration
- B60W 2520/14: Yaw
- B60W 2720/125: Lateral acceleration
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G06V: IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING

## Abstract

A trajectory planning method for lane changing of a vehicle includes steps of: calculating a current position of a reference point of the vehicle on a preliminary lane change trajectory that is received from an LCA system of the vehicle at a current time point; based on kinematics data received from an IMU of the vehicle, calculating longitudinal and lateral displacements of the reference point moving during a unit of time from the current time point to a next time point, and a yaw angle of the vehicle at the next time point; and obtaining a calibrated lane change trajectory based on the preliminary lane change trajectory, the current position, the longitudinal and lateral displacements, and the yaw angle.

## Claims

### Claim 1

A trajectory planning method for lane changing to be implemented by a processing unit installed on a vehicle, the vehicle being provided with a lane detection module for obtaining lane-line data that relates to lane lines of a road on which the vehicle is running, an inertial measurement unit (IMU) for obtaining kinematics data that relates to motion of the vehicle, and a lane change assist (LCA) system for generating a preliminary lane change trajectory, the trajectory planning method comprising steps of:
at a current time point, receiving the preliminary lane change trajectory from the LCA system, the lane-line data from the lane detection module, and the kinematics data from the IMU;
calculating a current position of a reference point of the vehicle on the preliminary lane change trajectory at the current time point based on the lane-line data received from the lane detection module at the current time point;
based on the kinematics data received from the IMU at the current time, calculating a longitudinal displacement and a lateral displacement of the reference point of the vehicle moving during a unit of time from the current time point to a next time point, and a yaw angle of the vehicle at the next time point; and
obtaining a calibrated lane change trajectory based on the preliminary lane change trajectory, the current position, the longitudinal displacement, the lateral displacement and the yaw angle, wherein the calibrated lane change trajectory starts from an estimated position, where the reference point of the vehicle is estimated to be located the next time point.

### Claim 2 (depends on 1)

The trajectory planning method of claim 1, wherein the step of obtaining a calibrated lane change trajectory includes:
obtaining a matrix equation that expresses a relation of a coordinate system defined in relation to the estimated position and another coordinate system defined in relation to the current position based the longitudinal displacement, the lateral displacement and the yaw angle; and
calculating the calibrated lane change trajectory based on the matrix equation and the preliminary lane change trajectory.

### Claim 3 (depends on 1)

The trajectory planning method of claim 1, further comprising, after the step of obtaining a calibrating lane change trajectory, steps of:
deriving a lateral trajectory curve from the calibrating lane change trajectory;
obtaining a lateral acceleration curve based on the lateral trajectory curve;
adjusting the lateral acceleration curve with reference to a preset acceleration magnitude threshold and a preset jerk magnitude threshold so as to obtain a target lateral acceleration curve;
obtaining a target lane change trajectory based on the target lateral acceleration curve; and
outputting the target lane change trajectory to the LCA system for controlling automated lane change of the vehicle.

### Claim 4 (depends on 3)

The trajectory planning method of claim 3, wherein the step of adjusting the lateral acceleration curve is to adjust the lateral acceleration curve with reference to a trapezoidal acceleration profile that consists of a positive trapezoidal segment having positive acceleration values and a negative trapezoidal segment having negative acceleration values, the positive and negative trapezoidal segments having a same shape and size that is related to the preset acceleration threshold and the preset jerk threshold.

### Claim 5 (depends on 4)

The trajectory planning method of claim 4, wherein the lateral acceleration curve is a sine wave curve having a positive half cycle, and a negative half cycle following and connected to the positive half cycle, wherein the step of adjusting the lateral acceleration curve includes:
adjusting the lateral acceleration curve in a manner that a maximum value of the positive half cycle is not greater than a positive preset acceleration threshold and a minimum value of the negative half cycle is not smaller than a negative preset acceleration threshold, wherein the positive preset acceleration threshold is the preset acceleration magnitude threshold with a positive sign, and the negative preset acceleration threshold is the preset acceleration magnitude threshold with a negative sign.

### Claim 6 (depends on 4)

The trajectory planning method of claim 4, further comprising:
differentiating the lateral acceleration curve to obtain a lateral jerk curve; and
adjusting the lateral jerk curve in a manner that any value of the lateral jerk curve is within a range between a positive preset jerk threshold and a negative preset jerk threshold, wherein the positive preset jerk threshold is the preset jerk magnitude threshold with a positive sign, and the negative preset jerk threshold is the preset jerk magnitude threshold with a negative sign.

### Claim 7 (depends on 3)

The trajectory planning method of claim 3, wherein the preset acceleration threshold is 3 m/s2, and the preset jerk threshold is 5 m/s3.

### Claim 8 (depends on 3)

The trajectory planning method of claim 3, the kinematics data including linear velocity data, angular velocity data and acceleration data of the vehicle, wherein the step of calculating the longitudinal displacement, the lateral displacement and the yaw angle, includes sub-steps of:
smoothing out noises of the angular velocity data and the acceleration data using Kalman filtering process;
estimating a yaw rate and a lateral acceleration value based on the smoothed angular velocity data and the smoothed acceleration data by means of Kalman estimations;
estimating the lateral displacement and the yaw angle based on the yaw rate, the lateral acceleration value and the unit of time; and
estimating the longitudinal displacement based on the linear velocity data, the yaw angle and the unit of time.

### Claim 9

A trajectory planning method to be implemented by a driver assistance system installed on a vehicle, the driver assistance system including a lane detection module, an inertial measurement unit (IMU), a lane change assist (LCA) system and a processing unit, the trajectory planning method comprising steps of:
obtaining, by the lane detection module, lane-line data that relates to lane lines of a road on which the vehicle is running;
obtaining, by the IMU, kinematics data that relates to motion of the vehicle;
generating, by the LCA system, a preliminary lane change trajectory at a current time point;
calculating, by the processing unit, a current position of a reference point of the vehicle on the preliminary lane change trajectory at the current time point based on the lane-line data received from the lane detection module at the current time point;
based on the kinematics data received from the IMU at the current time, calculating, by the processing unit, a longitudinal displacement and a lateral displacement of the reference point of the vehicle moving during a unit of time from the current time point to a next time point, and a yaw angle of the vehicle at the next time point; and
obtaining, by the processing unit, a calibrated lane change trajectory based on the preliminary lane change trajectory, the current position, the longitudinal displacement, the lateral displacement and the yaw angle, wherein the calibrated lane change trajectory starts from an estimated position, at which the reference point of the vehicle is estimated to be located the next time point.

### Claim 10

A driver assistance system configured to be installed on a vehicle, comprising:
a lane detection module configured to obtain lane-line data that relates to lane lines of a road on which the vehicle is running;
an inertial measurement unit (IMU) configured to obtain kinematics data that relates to motion of the vehicle;
a lane change assist (LCA) system configured to generate a preliminary lane change trajectory; and
a processing unit electrically connected to the lane detection module, the IMU and the LCA system, and configured, in response to receipt of the preliminary lane change trajectory from the LCA system at a current time point, to
calculate a current position of a reference point of the vehicle on the preliminary lane change trajectory at the current time point based on the lane-line data received from the lane detection module at the current time point,
based on the kinematics data received from the IMU at the current time, calculate a longitudinal displacement and a lateral displacement of the reference point of the vehicle moving during a unit of time from the current time point to a next time point, and a yaw angle of the vehicle at the next time point, and
obtain a calibrated lane change trajectory based on the preliminary lane change trajectory, the current position, the longitudinal displacement, the lateral displacement and the yaw angle, wherein the calibrated lane change trajectory starts from an estimated position, at which the reference point of the vehicle is estimated to be located the next time point.
