Move unused debug functions to krcam_util. Tidy up includes