Contact feature extraction on a balancing manipulation platform

The dynamic behavior of an inverted pendulum platform inherently reveals information about its interaction with the environment. The closed loop controller puts the unstable plant into dynamic equilibrium, where very small external forces result in persistent excitation of the system. Our previous work has shown that we are able to detect and estimate external forces on an inverted pendulum base using only dynamic state information from the controller. The Yale Inverted Pendulum Door Opening Robot (YIPDOR) has gained a simple 4 degree of freedom (DOF) arm with the goal of opening and traversing doorways with both heavy and sprung doors. We have explicitly omitted dedicated force sensors. Estimation methods using only the Jacobian and joint torques do not provide adequate estimates of external forces on this system. While improved force estimation continues to be a goal for the project, we propose that traversal of sprung doors may be accomplished with low-level, dynamic postures and detection of changes in dynamics rather than explicit force estimation and control. Changes in the equations of motion and dynamic constraints (contact, unlatching, door movement) are detected by using filtered derivatives of relevant parameters. This feature extraction research increases the safety and performance of the balancing and manipulation system without any additional dedicated sensors.