Fixes some issues with reference frames
Successful implementation of vision based control!