Fixed bug where setTalon does not reset to zero
Changed orientation of pitch/roll formulas
Updated .out file