A* optimal path

A* search algorithm for variable joint stiffness control in an underactuated system