Treffer: Numerical methods for optimal control of nonsmooth dynamical systems