Walking Mostly Works

Still have not dared to try the work cost function.