Efficient Multi Contact Planning with Different Level of Fidelity - View it on GitHub