Linear Velocity:
if we add and subtract the above equation:
so we express the pose of the robot in frame, we rotate it around that
degree and finally express it our world coordinate frame:
If we add orientation and write all positions in our world coordinate:
since we had :
Refs: 1
Not sure about the followings:
the pose of the robot at time t:
observed range and bearing of the landmark: