start implementation of penalty function time-optimal contron in cython
start implementation of penalty function time-optimal contron in cython