For ensuring robust SW, add a few new pieces of logging:
Use FPGA timestamp to mark the start/end of each *perioidic loop. On the next loop, log that elapsed time to file. Ensure the start/end encapsulates the logging overhead as well.
Log the ds.isNewControlData() return value to indicate if field coms lag or robot (for any reason) is not getting updates from the DS.
For ensuring robust SW, add a few new pieces of logging:
Use FPGA timestamp to mark the start/end of each *perioidic loop. On the next loop, log that elapsed time to file. Ensure the start/end encapsulates the logging overhead as well.
Log the ds.isNewControlData() return value to indicate if field coms lag or robot (for any reason) is not getting updates from the DS.