Explicit timestep for penalty method now works.