Solved the problem of not considering the ego motion. Now it is possible to define the frame w.r.t. the motion is being computed.