Added Shooter code and some PID for the shooter