Ground plane detection using visual and inertial data fusion