Moved shooter control to pid