Fixed the problem that the movement direction is different in real machine and model