sadmen
/
openpilot_comma
mirror of https://github.com/commaai/openpilot.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

add new interp

Browse Source
pull/27343/head
Bruce Wayne 2 years ago
parent 95815419d8
commit 659e5aa01a
1 changed files with 6 additions and 6 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 12
      selfdrive/controls/lib/lateral_planner.py

12
selfdrive/controls/lib/lateral_planner.py
Unescape View File

@ -80,12 +80,12 @@ class LateralPlanner:
LATERAL_ACCEL_COST, LATERAL_JERK_COST,
STEERING_RATE_COST)
#y_pts = np.interp(plan_odo, self.model_odo, self.path_xyz[:, 1])
#heading_pts = np.interp(plan_odo, self.model_odo, self.plan_yaw)
#yaw_rate_pts = np.interp(plan_odo, self.model_odo, self.plan_yaw_rate)
y_pts = np.interp(plan_odo, np.linalg.norm(self.path_xyz, axis=1), self.path_xyz[:, 1])
heading_pts = np.interp(plan_odo, np.linalg.norm(self.path_xyz, axis=1), self.plan_yaw)
yaw_rate_pts = np.interp(plan_odo, np.linalg.norm(self.path_xyz, axis=1), self.plan_yaw_rate)
y_pts = np.interp(plan_odo, self.model_odo, self.path_xyz[:, 1])
heading_pts = np.interp(plan_odo, self.model_odo, self.plan_yaw)
yaw_rate_pts = np.interp(plan_odo, self.model_odo, self.plan_yaw_rate)
#y_pts = np.interp(plan_odo, np.linalg.norm(self.path_xyz, axis=1), self.path_xyz[:, 1])
#heading_pts = np.interp(plan_odo, np.linalg.norm(self.path_xyz, axis=1), self.plan_yaw)
#yaw_rate_pts = np.interp(plan_odo, np.linalg.norm(self.path_xyz, axis=1), self.plan_yaw_rate)
self.y_pts = y_pts
assert len(y_pts) == LAT_MPC_N + 1

Write Preview
Loading…
Cancel
Save