Motion Profiling Trajectory Utility (MP Trajedy) CuritnFRC Trajectory controller and utility for auto path planning in FRC