Pivot-location uncertainty in a rotational clearance bound
ID: pivot-location-uncertainty-in-a-rotational-clearance-bound
Pivot-location uncertainty in a rotational clearance bound describes how an error in the point about which a rigid rotation is modeled changes predicted occupied-point motion. A radius measured about one pivot is not automatically valid about another. The underlying planning problem must include both translation and orientation of the robot’s actual geometry.[ref]
Robotic Systems by Kris Hauser. Chapter 9, C-obstacles for rotational motion and Motion planning in SE(2)
Let be a fixed rotation matrix, the modeled pivot, and the actual pivot. First suppose the initial physical point is known exactly and both descriptions use the same rotation . The modeled and actual endpoints areso their difference is exactlyThis vanishes for zero rotation even if the pivot location is uncertain. Treating pivot error as an arbitrary full translation at every angle can therefore be unnecessarily conservative.
For a rotation through principal angle about a known axis direction, the component of along that direction is unchanged by . Its perpendicular component giveswhen . The chord-length factor is the same geometry used in the angular clearance bound for a rotating body. For a rotation and , the maximum endpoint error from pivot location alone is about . An equally large pivot offset parallel to the axis produces no endpoint change in this model.
If the initial point also has error with , thenFor the difference of displacement vectors, rather than final positions, the shape term is , giving the different bound . The requested geometric quantity determines which allowance applies.
A complementary radius argument bounds total actual motion. If modeled points satisfy , then , and total point displacement is at most . This is the enclosure approach in uncertainty in a rigid-body bounding radius; it need not equal an endpoint-error calculation against a nominal path.
Correlations can reduce the bound. If the same coordinate-frame translation shifts both the modeled point and pivot, relative geometry may be unchanged; treating those two descriptions as independent physical errors loses that cancellation. Conversely, rotation-axis direction uncertainty in clearance bounds changes itself and is not covered by the fixed- pivot formula.
A proposed rotary-stage check observes several rigid fiducials, estimates the pivot and axis in one coordinate frame, and compares independent endpoint measurements at several angles with the predicted chord scaling. Include attached tools and measurement uncertainty. When the robot moves against an uncertain obstacle, combine this occupied-point model with a separately justified distance-query enclosure; a correct pivot bound does not establish the obstacle model’s accuracy.
New to topics? Read the docs here!