Got state_estimation to work with vrep video, simultaneously with live drone.