Hybrid Force-Position Control

A control framework that independently controls force along some Cartesian directions and position/velocity along the complementary directions. The task space is partitioned using a selection matrix: force-controlled axes maintain desired contact forces while position-controlled axes follow geometric trajectories. Used for tasks like surface polishing, peg insertion, and contour following.