Mathematically what you have should work. Are you using tool radius comp? Are you using an origin shift? These things could cause errors with some older Fanuc controllers.