Fixed angle measurement
Merge https://github.com/robotics-silver-surfer/surfer-main