标题: 串口三轴CNC控制类（只实现了G00和G01两条命令） [打印本页]
作者: liuyy    时间: 2015-1-11 20:11
标题: 串口三轴CNC控制类（只实现了G00和G01两条命令）
  1. #include
  2. using namespace std;

  4. class CNC //CNC控制类
  5. {
  6. //私有方法部分
  7. protected:
  8. int CNC_x;//x轴当前值
  9. int CNC_y;//y轴当前值
  10. int CNC_Z;//z轴当前值
  11. int CNC_YS_X;//原点x坐标值
  12. int CNC_YS_Y;//原点y坐标值
  13. int CNC_YS_Z;//原点z坐标值

  15. //屏幕GDI函数用到的一些坐标
  16. int CNC_GDI_X; //屏幕显示偏移坐标
  17. int CNC_GDI_Y;
  18. int CNC_GDI_X_x; //x框架轴坐标
  19. int CNC_GDI_X_y;
  20. int CNC_GDI_Y_x; //y轴框架坐标
  21. int CNC_GDI_Y_y;
  22. int CNC_GDI_Z_x; //z轴框架坐标
  23. int CNC_GDI_Z_y;
  24. int CNC_GDI_D_x; /具位置坐标
  25. int CNC_GDI_D_y;
  26. int CNC_GDI_D_Z; //下刀深度

  28. //GDI函数用到的一些句柄
  29. HDC hdc; //获取绘图DC句柄
  30. HPEN hpen_x; //x轴画笔
  31. HBRUSH hbrush_x; //x轴画刷
  32. HPEN hpen_y; //y轴画笔
  33. HBRUSH hbrush_y; //y轴画刷
  34. HPEN hpen_z; //z轴画笔
  35. HBRUSH hbrush_z; //z轴画刷
  36. HPEN hpen_D; /路画笔
  37. HPEN hpen_cls; //清屏画笔
  38. HBRUSH hbrush_cls; //清屏画刷
  39. HPEN hpen_GJ; //工件画笔
  40. HBRUSH hbrush_GJ; //工件画刷




  45. //公共方法部分
  46. public:
  47. CNC(void);
  48. ~CNC(void);
  49. void CNC_GDI_DC(void); //初始化GDI绘图相关句柄
  50. void CNC_GDI_CLS(void); //清屏并画工件
  51. void CNC_GDI(void); //屏幕输出CNC状态
  52. void CNC_X_进(void); //x轴操作
  53. void CNC_X_退(void);
  54. void CNC_Y_进(void); //y轴操作
  55. void CNC_Y_退(void);
  56. void CNC_Z_进(void); //z轴操作
  57. void CNC_Z_退(void);
  58. void CNC_COM(void); //COM口驱动信号输出
  59. void CNC_DuiDao(void); //手动对刀设置原点
  60. int CNC_G00(char x,int x_z,char y,int y_z,char z,int z_z); //G00指令实现
  61. int CNC_G01(char x,int x_z,char y,int y_z,char z,int z_z,int f); //G01指令实现
  62. };


  65. #include "stdafx.h"
  66. #include "CNC控制.h"

  68. int CNC_GDI_DL[440][780];

  70. CNC::CNC(void)
  71. {
  72. //初始化
  73. //屏幕显示参考坐标,整个三轴都以此点为偏移
  74. CNC_GDI_X=30;
  75. CNC_GDI_Y=20;
  76. //为x，y，z轴坐标值及刀具位置坐标赋初值
  77. CNC_GDI_X_x=CNC_GDI_X; //x轴宽度为900像素
  78. CNC_GDI_X_y=CNC_GDI_Y;
  79. CNC_GDI_Y_x=CNC_GDI_X_x+10; //y轴宽度为500像素
  80. CNC_GDI_Y_y=CNC_GDI_X_y-10;
  81. CNC_GDI_Z_x=CNC_GDI_Y_x-10; //z轴深度屏幕上无法表示出来
  82. CNC_GDI_Z_y=CNC_GDI_Y_y+20;
  83. CNC_GDI_D_x=CNC_GDI_Z_x+35; /具位置坐标
  84. CNC_GDI_D_y=CNC_GDI_Z_y+25;
  85. CNC_GDI_D_Z=0; //下刀深度初始化
  86. int x,y;
  87. for(y=0;y<440;y++)
  88. for(x=0;x<780;x++)
  89. {
  90. CNC_GDI_DL[y][x]=0;
  91. }

  93. //////////////////////////////////////
  94. //初始化原点
  95. CNC_YS_X=CNC_GDI_D_x;
  96. CNC_YS_Y=CNC_GDI_D_y;
  97. CNC_YS_Z=CNC_GDI_D_Z;


  100. }

  102. CNC::~CNC(void)
  103. {
  104. // 释放资源
  105. DeleteObject(hpen_x);
  106. DeleteObject(hbrush_x);
  107. DeleteObject(hpen_y);
  108. DeleteObject(hbrush_y);
  109. DeleteObject(hpen_z);
  110. DeleteObject(hbrush_z);
  111. DeleteObject(hpen_x);
  112. DeleteObject(hpen_D);
  113. DeleteObject(hpen_x);

  115. }

  117. void CNC::CNC_GDI_CLS(void)
  118. {
  119. // 为DC选择笔和笔刷
  120. SelectObject(hdc, hpen_cls);
  121. SelectObject(hdc, hbrush_cls);
  122. // 绘制清屏矩形
  123. Rectangle( hdc,0,0,900,550 );
  124. // 为DC选择笔和笔刷
  125. SelectObject(hdc, hpen_GJ);
  126. SelectObject(hdc, hbrush_GJ);
  127. // 绘制工件矩形
  128. Rectangle( hdc,80,60,800,500 );
  129. //绘制刀路
  130. int x,y;
  131. if(CNC_GDI_D_Z>0&&CNC_GDI_D_y>=60&&CNC_GDI_D_x>=70&&CNC_GDI_D_y<=500&&CNC_GDI_D_x<=850)
  132. {
  133. //记录刀路

  135. CNC_GDI_DL[CNC_GDI_D_y-60][CNC_GDI_D_x-70]=CNC_GDI_D_Z;
  136. }

  138. for(y=0;y<440;y++)
  139. for(x=0;x<780;x++)
  140. {
  141. if(CNC_GDI_DL[y][x]!=0)
  142. {
  143. SetPixel (hdc, x+70, y+60,RGB(0,0,255));
  144. }
  145. }

  147. }

  149. void CNC::CNC_GDI_DC(void)
  150. {
  151. //初始化绘图DC
  152. CWnd * pWnd = AfxGetMainWnd();
  153. HWND haha = pWnd->m_hWnd;
  154. hdc = GetDC(haha); //这个DC为全局的
  155. hpen_x=CreatePen(PS_SOLID,1, RGB(255,255,0));
  156. hbrush_x=CreateSolidBrush(RGB(255,255,0));
  157. hpen_y=CreatePen(PS_SOLID,1, RGB(0,255,0));
  158. hbrush_y=CreateSolidBrush(RGB(0,255,0));
  159. hpen_z=CreatePen(PS_SOLID,1, RGB(255,0,0));
  160. hbrush_z=CreateSolidBrush(RGB(255,0,0));
  161. hpen_D=CreatePen(PS_SOLID,1, RGB(0,0,255));
  162. hpen_cls=CreatePen(PS_SOLID,1, RGB(0,0,0));
  163. hbrush_cls=CreateSolidBrush(RGB(0,0,0));
  164. hpen_GJ=CreatePen(PS_SOLID,1, RGB(128,255,255));
  165. hbrush_GJ=CreateSolidBrush(RGB(128,255,255));

  167. }

  169. void CNC::CNC_GDI(void)
  170. {
  171. CNC_GDI_CLS();
  172. // 为DC选择笔和笔刷
  173. SelectObject(hdc, hpen_x);
  174. SelectObject(hdc, hbrush_x);
  175. // 绘制x轴框架
  176. Rectangle( hdc,CNC_GDI_X_x,CNC_GDI_X_y,CNC_GDI_X_x+900,CNC_GDI_X_y+10 );
  177. Rectangle( hdc,CNC_GDI_X_x,CNC_GDI_X_y+510,CNC_GDI_X_x+900,CNC_GDI_X_y+10+510 );
  178. ///////////////////////////////////////////////////
  179. // 为DC选择笔和笔刷
  180. SelectObject(hdc, hpen_y);
  181. SelectObject(hdc, hbrush_y);
  182. // 绘制y轴框架
  183. Rectangle( hdc,CNC_GDI_Y_x,CNC_GDI_Y_y,CNC_GDI_Y_x+10,CNC_GDI_Y_y+540 );
  184. Rectangle( hdc,CNC_GDI_Y_x+40,CNC_GDI_Y_y,CNC_GDI_Y_x+10+40,CNC_GDI_Y_y+540 );
  185. ///////////////////////////////////////////////////
  186. // 为DC选择笔和笔刷
  187. SelectObject(hdc, hpen_z);
  188. SelectObject(hdc, hbrush_z);
  189. // 绘制z轴框架
  190. Rectangle( hdc,CNC_GDI_Z_x,CNC_GDI_Z_y,CNC_GDI_Z_x+70,CNC_GDI_Z_y+10 );
  191. Rectangle( hdc,CNC_GDI_Z_x,CNC_GDI_Z_y+40,CNC_GDI_Z_x+70,CNC_GDI_Z_y+10+40 );
  192. Rectangle( hdc,CNC_GDI_Z_x+30,CNC_GDI_Z_y+20,CNC_GDI_Z_x+40,CNC_GDI_Z_y+30);
  193. }

  195. void CNC::CNC_COM(void)
  196. {
  197. //从串口输出三轴步进电机驱动信号
  198. }

  200. void CNC::CNC_DuiDao(void)
  201. {
  202. //手动对刀设置原点
  203. CNC_YS_X=CNC_GDI_D_x;
  204. CNC_YS_Y=CNC_GDI_D_y;
  205. CNC_YS_Z=CNC_GDI_D_Z;
  206. }

  208. void CNC::CNC_X_进(void)
  209. {
  210. //x轴进给一个单位
  211. if(CNC_GDI_Y_x<(CNC_GDI_X+840))
  212. {
  213. CNC_GDI_Y_x+=1;
  214. CNC_GDI_Z_x+=1;
  215. CNC_GDI_D_x+=1;
  216. CNC_GDI();
  217. CNC_COM();
  218. }
  219. }

  221. void CNC::CNC_X_退(void)
  222. {
  223. //x轴后退一个单位
  224. if(CNC_GDI_Y_x>CNC_GDI_X+10)
  225. {
  226. CNC_GDI_Y_x-=1;
  227. CNC_GDI_Z_x-=1;
  228. CNC_GDI_D_x-=1;
  229. CNC_GDI();
  230. CNC_COM();
  231. }
  232. }

  234. void CNC::CNC_Y_进(void)
  235. {
  236. //y轴进给一个单位
  237. if(CNC_GDI_Z_y<(CNC_GDI_Y+460))
  238. {
  239. CNC_GDI_Z_y+=1;
  240. CNC_GDI_D_y+=1;
  241. CNC_GDI();
  242. CNC_COM();
  243. }
  244. }

  246. void CNC::CNC_Y_退(void)
  247. {
  248. //y轴后退一个单位
  249. if(CNC_GDI_Z_y>(CNC_GDI_Y+10))
  250. {
  251. CNC_GDI_Z_y-=1;
  252. CNC_GDI_D_y-=1;
  253. CNC_GDI();
  254. CNC_COM();
  255. }
  256. }

  258. void CNC::CNC_Z_进(void)
  259. {
  260. if(CNC_GDI_D_Z<10)
  261. {
  262. CNC_GDI_D_Z+=1;
  263. }
  264. CNC_GDI();
  265. CNC_COM();
  266. }

  268. void CNC::CNC_Z_退(void)
  269. {
  270. if(CNC_GDI_D_Z>0)
  271. {
  272. CNC_GDI_D_Z-=1;
  273. }
  274. CNC_GDI();
  275. CNC_COM();
  276. }

  278. int CNC::CNC_G00(char x,int x_z,char y,int y_z,char z,int z_z)
  279. {
  280. //G00指令实现
  281. int a,b,c;
  282. CNC_GDI_D_Z=0;
  283. for( a=1,b=1,c=1;a==1||b==1||c==1;)
  284. {
  285. if((x_z+CNC_YS_X)==CNC_GDI_D_x)
  286. {
  287. a=0;
  288. } else if((x_z+CNC_YS_X)<CNC_GDI_D_x&&a==1)
  289. {
  290. CNC_X_退();
  291. }else if((x_z+CNC_YS_X)>CNC_GDI_D_x&&a==1)
  292. {
  293. CNC_X_进();
  294. }

  296. if((y_z+CNC_YS_Y)==CNC_GDI_D_y)
  297. {
  298. b=0;
  299. } else if((y_z+CNC_YS_Y)<CNC_GDI_D_y&&b==1)
  300. {
  301. CNC_Y_退();
  302. }else if((y_z+CNC_YS_Y)>CNC_GDI_D_y&&b==1)
  303. {
  304. CNC_Y_进();
  305. }

  307. if((z_z+CNC_YS_Z)==CNC_GDI_D_Z)
  308. {
  309. c=0;
  310. } else if((z_z+CNC_YS_Z)<CNC_GDI_D_Z&&c==1)
  311. {
  312. CNC_Z_退();
  313. }else if((z_z+CNC_YS_Z)>CNC_GDI_D_Z&&c==1)
  314. {
  315. CNC_Z_进();
  316. }
  317. Sleep(10);

  319. }


  322. return 1;
  323. }

  325. int CNC::CNC_G01(char x,int x_z,char y,int y_z,char z,int z_z,int f)
  326. {
  327. //G00指令实现
  328. int a,b,c;
  329. for( a=1,b=1,c=1;a==1||b==1||c==1;)
  330. {
  331. if((x_z+CNC_YS_X)==CNC_GDI_D_x)
  332. {
  333. a=0;
  334. } else if((x_z+CNC_YS_X)<CNC_GDI_D_x&&a==1)
  335. {
  336. CNC_X_退();
  337. }else if((x_z+CNC_YS_X)>CNC_GDI_D_x&&a==1)
  338. {
  339. CNC_X_进();
  340. }

  342. if((y_z+CNC_YS_Y)==CNC_GDI_D_y)
  343. {
  344. b=0;
  345. } else if((y_z+CNC_YS_Y)<CNC_GDI_D_y&&b==1)
  346. {
  347. CNC_Y_退();
  348. }else if((y_z+CNC_YS_Y)>CNC_GDI_D_y&&b==1)
  349. {
  350. CNC_Y_进();
  351. }

  353. if((z_z+CNC_YS_Z)==CNC_GDI_D_Z)
  354. {
  355. c=0;
  356. } else if((z_z+CNC_YS_Z)<CNC_GDI_D_Z&&c==1)
  357. {
  358. CNC_Z_退();
  359. }else if((z_z+CNC_YS_Z)>CNC_GDI_D_Z&&c==1)
  360. {
  361. CNC_Z_进();
  362. }
  363. Sleep(f);

  365. }
  366. return 1;
  367. }
复制代码


作者: wuxishun    时间: 2017-12-3 12:47
这是51单片机程序吗



欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1