|
|
@ -30,7 +30,7 @@ class LatControlPID(LatControl): |
|
|
|
pid_log.steeringRateDeg = float(CS.steeringRateDeg) |
|
|
|
pid_log.steeringRateDeg = float(CS.steeringRateDeg) |
|
|
|
|
|
|
|
|
|
|
|
angle_steers_des_no_offset = math.degrees(VM.get_steer_from_curvature(-desired_curvature, CS.vEgo, params.roll)) |
|
|
|
angle_steers_des_no_offset = math.degrees(VM.get_steer_from_curvature(-desired_curvature, CS.vEgo, params.roll)) |
|
|
|
angle_steers_des = angle_steers_des_no_offset + params.angleOffsetDeg |
|
|
|
angle_steers_des = angle_steers_des_no_offset #+ params.angleOffsetDeg |
|
|
|
error = angle_steers_des - CS.steeringAngleDeg |
|
|
|
error = angle_steers_des - CS.steeringAngleDeg |
|
|
|
|
|
|
|
|
|
|
|
pid_log.steeringAngleDesiredDeg = angle_steers_des |
|
|
|
pid_log.steeringAngleDesiredDeg = angle_steers_des |
|
|
|