A libary made for my FRC team, adding Trajectory solvers and pre-made subsystem wrappers.