Right now, NAND Telemetry is pretty scuffed, and needs to be properly communicated with firmware.
Currently, only passed in velocity as a singular value, which means that the twist is impossible to calculate, and should be done properly.
Additionally, heading calculations needs to be double checked.
Overall, this change has not been mock rolled and not stable, although it is on the main branch.
Suspicious code:
speed = packet.velocity
# TODO: fix this
# why this works: autonsystem only cares about magnitude of velocity
# so setting an arbitrary axis to the speed and leave other at 0
# works. However, this should be done properly ASAP
odom.twist.twist.linear.x = speed
Right now, NAND Telemetry is pretty scuffed, and needs to be properly communicated with firmware.
Currently, only passed in velocity as a singular value, which means that the twist is impossible to calculate, and should be done properly. Additionally, heading calculations needs to be double checked.
Overall, this change has not been mock rolled and not stable, although it is on the main branch.
Suspicious code: