(self, veh: Vehicle | egoCar)
| 239 | veh.dbTrajectory = dbTrajectory |
| 240 | |
| 241 | def updateVeh(self, veh: Vehicle | egoCar): |
| 242 | self.setDBTrajectory(veh) |
| 243 | if veh.dbTrajectory and veh.dbTrajectory.xQueue: |
| 244 | (x, y, yaw, speed, accel, laneID, lanePos, |
| 245 | routeIdx) = veh.dbTrajectory.pop_last_state_r() |
| 246 | veh.xQ.append(x) |
| 247 | veh.yQ.append(y) |
| 248 | veh.yawQ.append(yaw) |
| 249 | veh.speedQ.append(speed) |
| 250 | veh.accelQ.append(accel) |
| 251 | if veh.dbTrajectory.laneIDQueue: |
| 252 | veh.laneIDQ.append(laneID) |
| 253 | veh.lanePosQ.append(lanePos) |
| 254 | veh.routeIdxQ.append(routeIdx) |
| 255 | |
| 256 | def plotVState(self): |
| 257 | if self.ego.speedQ: |
no test coverage detected