second_order_dynamics library