Added some print-outs to CRS-planner and target-pred. Fixed the shamefully wrong grapple fixture position / orientation.