Debugged c-axis misor. and YAML file loading functions