26
26
MAX_ACC_DELTA = 0.5
27
27
DEL_T = 0.1
28
28
29
- State = namedtuple ('State' , ['roll_lataccel' , 'vEgo ' , 'aEgo ' ])
29
+ State = namedtuple ('State' , ['roll_lataccel' , 'v_ego ' , 'a_ego ' ])
30
30
31
31
32
32
class LataccelTokenizer :
@@ -114,9 +114,10 @@ def get_data(self, data_path: str) -> pd.DataFrame:
114
114
df = pd .read_csv (data_path )
115
115
processed_df = pd .DataFrame ({
116
116
'roll_lataccel' : np .sin (df ['roll' ].values ) * ACC_G ,
117
- 'vEgo' : df ['vEgo' ].values ,
118
- 'aEgo' : df ['aEgo' ].values ,
119
- 'target_lataccel' : df ['latAccelSteeringAngle' ].values ,
117
+ 'v_ego' : df ['vEgo' ].values ,
118
+ 'a_ego' : df ['aEgo' ].values ,
119
+ 'target_lataccel' : df ['targetLateralAcceleration' ].values ,
120
+ 'steer_command' : df ['steerCommand' ].values
120
121
})
121
122
return processed_df
122
123
@@ -142,7 +143,7 @@ def control_step(self, step_idx: int) -> None:
142
143
143
144
def get_state_target (self , step_idx : int ) -> Tuple [List , float ]:
144
145
state = self .data .iloc [step_idx ]
145
- return State (roll_lataccel = state ['roll_lataccel' ], vEgo = state ['vEgo ' ], aEgo = state ['aEgo ' ]), state ['target_lataccel' ]
146
+ return State (roll_lataccel = state ['roll_lataccel' ], v_ego = state ['v_ego ' ], a_ego = state ['a_ego ' ]), state ['target_lataccel' ]
146
147
147
148
def step (self ) -> None :
148
149
state , target = self .get_state_target (self .step_idx )
@@ -181,7 +182,7 @@ def rollout(self) -> None:
181
182
self .plot_data (ax [0 ], [(self .target_lataccel_history , 'Target lataccel' ), (self .current_lataccel_history , 'Current lataccel' )], ['Step' , 'Lateral Acceleration' ], 'Lateral Acceleration' )
182
183
self .plot_data (ax [1 ], [(self .action_history , 'Action' )], ['Step' , 'Action' ], 'Action' )
183
184
self .plot_data (ax [2 ], [(np .array (self .state_history )[:, 0 ], 'Roll Lateral Acceleration' )], ['Step' , 'Lateral Accel due to Road Roll' ], 'Lateral Accel due to Road Roll' )
184
- self .plot_data (ax [3 ], [(np .array (self .state_history )[:, 1 ], 'vEgo ' )], ['Step' , 'vEgo ' ], 'vEgo ' )
185
+ self .plot_data (ax [3 ], [(np .array (self .state_history )[:, 1 ], 'v_ego ' )], ['Step' , 'v_ego ' ], 'v_ego ' )
185
186
plt .pause (0.01 )
186
187
187
188
if self .debug :
0 commit comments