Increased publish frequency of robot state