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.