mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-04 04:52:09 +08:00
New model: better laneless (#24605)
* Fix ping pong * Fix hugging: e6fd3a62-aa86-46d1-a414-19137ed1babc/800 * Remove lateral toggle * a6da6265-1952-48dd-986b-2b5996dd2642/950 * Model replay commit * Revert "Remove lateral toggle" This reverts commit 69e57eb7e1a72e4bad5e12bcfded6ff431a21a0e. old-commit-hash: 7da48ebdba5e3cf4c0b8078c934bee9a199f0280
This commit is contained in:
@@ -62,10 +62,9 @@ class LateralPlanner:
|
||||
self.lat_mpc.set_weights(MPC_COST_LAT.PATH, MPC_COST_LAT.HEADING, self.steer_rate_cost)
|
||||
else:
|
||||
d_path_xyz = self.path_xyz
|
||||
path_cost = np.clip(abs(self.path_xyz[0, 1] / self.path_xyz_stds[0, 1]), 0.5, 1.5) * MPC_COST_LAT.PATH
|
||||
# Heading cost is useful at low speed, otherwise end of plan can be off-heading
|
||||
heading_cost = interp(v_ego, [5.0, 10.0], [MPC_COST_LAT.HEADING, 0.0])
|
||||
self.lat_mpc.set_weights(path_cost, heading_cost, self.steer_rate_cost)
|
||||
heading_cost = interp(v_ego, [5.0, 10.0], [MPC_COST_LAT.HEADING, 0.15])
|
||||
self.lat_mpc.set_weights(MPC_COST_LAT.PATH, heading_cost, self.steer_rate_cost)
|
||||
|
||||
y_pts = np.interp(v_ego * self.t_idxs[:LAT_MPC_N + 1], np.linalg.norm(d_path_xyz, axis=1), d_path_xyz[:, 1])
|
||||
heading_pts = np.interp(v_ego * self.t_idxs[:LAT_MPC_N + 1], np.linalg.norm(self.path_xyz, axis=1), self.plan_yaw)
|
||||
|
||||
@@ -1,3 +1,3 @@
|
||||
version https://git-lfs.github.com/spec/v1
|
||||
oid sha256:ba3fe3e61853cc1434e3e220f40c8e9d1f1b9bab8458196ba3bea6a10b82c6ed
|
||||
size 72718099
|
||||
oid sha256:027cbb1fabae369878271cb0e3505071a8bdaa07473fad9a0b2e8d695c5dc1ff
|
||||
size 76725611
|
||||
|
||||
@@ -1,3 +1,3 @@
|
||||
version https://git-lfs.github.com/spec/v1
|
||||
oid sha256:bda57c1a66944f5a633ecd739a24d62702c717a234f2fdcc499dfa1d61c3c19e
|
||||
size 73147489
|
||||
oid sha256:484976ea5bd4ddcabc82e95faf30d7311a27802c1e337472558699fa2395a499
|
||||
size 77472267
|
||||
|
||||
@@ -1 +1 @@
|
||||
5fb5cd71a6e878cf45593ecea22c93e932f70c31
|
||||
f74ab97371be93fdc28333e5ea12bbb78c3a32d0
|
||||
|
||||
Reference in New Issue
Block a user