Implement the case of fixing the force. This is not a good approach since the feasible solution is unique and thus the angular momentum is not decreasing. Will optimize over the contact points