Added cleaner conversion from Vicon to NED frame.
Merge branch 'resl-indoor' of github.com:usc-resl/Firmware into resl-indoor