added logging for HeadStep, added option to go back for IK condition