Implementation of the sl1m solver for multi contact planning