The robot works, it also kinda has an autonomous mode. End of unbag 2.
Fix autonomous preset bug. Hopefully