Changed GPR error correction to learn either cam to FK or FK to cam and learn from 6 DOF poses insted of robot joints