xhouse/EF3-Interface
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Add Rotary axis。-Ed

Browse Source
This commit is contained in:
TAO Cheng
2014-02-24 21:33:42 +08:00
parent 7dcc572301
commit 4e781a690f
8 changed files with 364 additions and 30 deletions
Download Patch File Download Diff File Expand all files Collapse all files
PcDmis/Base/Interfac/Msi/Hsi/SevenOcean/SO7_Proto.cpp
+7 -4
View File
@@ -4697,18 +4697,21 @@ SSI_STATUS_MOTION CSO7_Proto::_process_SO7_CMD_READ_AXIS_XYZ()
g_machine.z._scale_pos._char_[1] = *(ep_buff[EP_82_DATA_IDX]._buffer+7);
g_machine.z._scale_pos._char_[0] = *(ep_buff[EP_82_DATA_IDX]._buffer+8);
g_machine.z._scale_pos._char_[3] = 0;
if (g_machine.x._scale_pos._long_ > 8388608)
g_machine.x._scale_pos._long_=g_machine.x._scale_pos._long_-16777216;
if (g_machine.y._scale_pos._long_ > 8388608)
g_machine.y._scale_pos._long_=g_machine.y._scale_pos._long_-16777216;
if (g_machine.z._scale_pos._long_ > 8388608)
g_machine.z._scale_pos._long_=g_machine.z._scale_pos._long_-16777216;
// if (g_machine.z._scale_pos._long_ > 8388608)
// g_machine.z._scale_pos._long_=g_machine.z._scale_pos._long_-16777216;
return SSI_STATUS_MOTION_NORMAL;
// for rotary table
if (g_machine.z._scale_pos._long_ > 4194304)
g_machine.z._scale_pos._long_=g_machine.z._scale_pos._long_-8388608;
return SSI_STATUS_MOTION_NORMAL;
};
//==============================================================