Change the way tool offset is handled in robot