Moved around function prototypes and hardcoded zero points for sensors ; created a semaphore for each publicly accessed variable to reduce the amount of time spent in KalmanGyro::calcAngle(3) holding semaphores ; added comment to KalmanGyro.hpp describing the class's usage and tips