Display steering angle, speed & cones in AMI
This commit is contained in:
@ -1,6 +1,7 @@
|
||||
#include <gui/ami_screen/AMIPresenter.hpp>
|
||||
#include <gui/ami_screen/AMIView.hpp>
|
||||
|
||||
#include "stm32h7xx_hal.h"
|
||||
#include "vehicle_state.h"
|
||||
|
||||
AMIPresenter::AMIPresenter(AMIView &v) : view(v) {}
|
||||
@ -11,4 +12,19 @@ void AMIPresenter::deactivate() {}
|
||||
|
||||
void AMIPresenter::vehicleStateUpdated() {
|
||||
view.setMission(vehicle_state.active_mission);
|
||||
view.updateDataFields();
|
||||
#ifndef SIMULATOR
|
||||
view.setJetsonTimeout(HAL_GetTick() - vehicle_state.last_jetson_msg > 500);
|
||||
view.setEPSCTimeout(HAL_GetTick() - vehicle_state.last_epsc_msg > 500);
|
||||
#endif
|
||||
|
||||
size_t cone_count = 0;
|
||||
for (; cone_count < NUM_CONES; cone_count++) {
|
||||
// A cone position of 0xFF/0xFF indicates that there are no more cones
|
||||
if (vehicle_state.cone_pos[cone_count].x == 0xFF &&
|
||||
vehicle_state.cone_pos[cone_count].y == 0xFF) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
view.setConePositions(vehicle_state.cone_pos, cone_count);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user