Added DriveForwardAndShoot command group and DisengageWinch command, also minor edits and commenting