Added and fixed a few things

Added a low pass filter to the tail servo
Moved variables to config file
Changed PID Values