added saftey to pwm, cleaned up pwm, fixed memory bugs in control_alg
Merge branch 'master' of github.com:Rose-Hulman-ROBO4xx/1314-BeagleBone-Quadcopter