Added #defines for using optical flow vs. VRPN and using integrated gyro for yaw. Updated Gyro Z bias. Changed some sensor processing regarding optical flow.
Properly setting sampling time for altitude PID with LiDAR. Fixed HW impl tests for lidar_t changes.
This reverts commit 822cbd7c