Fixed an issue on gotoXYZ()