Rotational and translational bias estimation based on depth and image measurements