Teensy pin pin configuration

Everything works except for the gyro. Further testing is needed on the failsafe, but it's pretty close as well. This should be the starting point for modifying the gyro code to get it working.