Major Refactor, new Controllers Pos/Vel, documentation needs updating.