fixing new conditional to cover the case that time has not progressed yet port forward of ros/geometry#35