This is command based code for the 2022-Robot! Has some fun features like trajectory tracking/motion profiling, a new logging system, and a working five ball autonomous. This was used at Boiler Bot Battle, and features frc868/houndutil as a major component.