?? csudlg.cpp
字號:
// CSUDlg.cpp : implementation file
//
#include "stdafx.h"
#include "CSU.h"
#include "CSUDlg.h"
#include "GT400SV.H"
#include "DotDlg.h"
#include "LineDlg.h"
#include "ArcDlg.h"
#ifdef _DEBUG
#define new DEBUG_NEW
#undef THIS_FILE
static char THIS_FILE[] = __FILE__;
#endif
/////////////////////////////////////////////////////////////////////////////
// CAboutDlg dialog used for App About
class CAboutDlg : public CDialog
{
public:
CAboutDlg();
// Dialog Data
//{{AFX_DATA(CAboutDlg)
enum { IDD = IDD_ABOUTBOX };
//}}AFX_DATA
// ClassWizard generated virtual function overrides
//{{AFX_VIRTUAL(CAboutDlg)
protected:
virtual void DoDataExchange(CDataExchange* pDX); // DDX/DDV support
//}}AFX_VIRTUAL
// Implementation
protected:
//{{AFX_MSG(CAboutDlg)
//}}AFX_MSG
DECLARE_MESSAGE_MAP()
};
CAboutDlg::CAboutDlg() : CDialog(CAboutDlg::IDD)
{
//{{AFX_DATA_INIT(CAboutDlg)
//}}AFX_DATA_INIT
}
void CAboutDlg::DoDataExchange(CDataExchange* pDX)
{
CDialog::DoDataExchange(pDX);
//{{AFX_DATA_MAP(CAboutDlg)
//}}AFX_DATA_MAP
}
BEGIN_MESSAGE_MAP(CAboutDlg, CDialog)
//{{AFX_MSG_MAP(CAboutDlg)
// No message handlers
//}}AFX_MSG_MAP
END_MESSAGE_MAP()
/////////////////////////////////////////////////////////////////////////////
// CCSUDlg dialog
CCSUDlg::CCSUDlg(CWnd* pParent /*=NULL*/)
: CDialog(CCSUDlg::IDD, pParent)
{
//{{AFX_DATA_INIT(CCSUDlg)
m_angle = 0.0;
m_enter = 0.0;
m_radius = 0.0;
m_speed = 0.0;
m_xcenter = 0.0;
m_xendpos = 0.0;
m_ycenter = 0.0;
m_yendpos = 0.0;
//}}AFX_DATA_INIT
// Note that LoadIcon does not require a subsequent DestroyIcon in Win32
m_hIcon = AfxGetApp()->LoadIcon(IDR_MAINFRAME);
}
void CCSUDlg::DoDataExchange(CDataExchange* pDX)
{
CDialog::DoDataExchange(pDX);
//{{AFX_DATA_MAP(CCSUDlg)
DDX_Control(pDX, IDC_COMBO_MStyle, m_Mstyle);
DDX_Control(pDX, IDC_COMBO_Dir, m_Dir);
DDX_Text(pDX, IDC_EDIT_angle, m_angle);
DDX_Text(pDX, IDC_EDIT_enter, m_enter);
DDX_Text(pDX, IDC_EDIT_radius, m_radius);
DDX_Text(pDX, IDC_EDIT_speed, m_speed);
DDX_Text(pDX, IDC_EDIT_xcenter, m_xcenter);
DDX_Text(pDX, IDC_EDIT_xendpos, m_xendpos);
DDX_Text(pDX, IDC_EDIT_ycenter, m_ycenter);
DDX_Text(pDX, IDC_EDIT_yendpos, m_yendpos);
//}}AFX_DATA_MAP
}
BEGIN_MESSAGE_MAP(CCSUDlg, CDialog)
//{{AFX_MSG_MAP(CCSUDlg)
ON_WM_SYSCOMMAND()
ON_WM_PAINT()
ON_WM_QUERYDRAGICON()
ON_BN_CLICKED(IDC_BUTTON_allzero, OnBUTTONallzero)
ON_BN_CLICKED(IDC_BUTTON_beginrun, OnBUTTONbeginrun)
ON_BN_CLICKED(IDC_BUTTON_circle, OnBUTTONcircle)
ON_BN_CLICKED(IDC_BUTTON_dot, OnBUTTONdot)
ON_BN_CLICKED(IDC_BUTTON_line, OnBUTTONline)
ON_BN_CLICKED(IDC_BUTTON_xminus, OnBUTTONxminus)
ON_BN_CLICKED(IDC_BUTTON_xmzero, OnBUTTONxmzero)
ON_BN_CLICKED(IDC_BUTTON_xplus, OnBUTTONxplus)
ON_BN_CLICKED(IDC_BUTTON_xpzero, OnBUTTONxpzero)
ON_BN_CLICKED(IDC_BUTTON_yminus, OnBUTTONyminus)
ON_BN_CLICKED(IDC_BUTTON_ymzero, OnBUTTONymzero)
ON_BN_CLICKED(IDC_BUTTON_yplus, OnBUTTONyplus)
ON_BN_CLICKED(IDC_BUTTON_ypzero, OnBUTTONypzero)
ON_BN_CLICKED(IDC_BUTTON_zminus, OnBUTTONzminus)
ON_BN_CLICKED(IDC_BUTTON_zmzero, OnBUTTONzmzero)
ON_BN_CLICKED(IDC_BUTTON_zplus, OnBUTTONzplus)
ON_BN_CLICKED(IDC_BUTTON_zpzero, OnBUTTONzpzero)
ON_CBN_SELCHANGE(IDC_COMBO_MStyle, OnSelchangeCOMBOMStyle)
//}}AFX_MSG_MAP
END_MESSAGE_MAP()
/////////////////////////////////////////////////////////////////////////////
// CCSUDlg message handlers
BOOL CCSUDlg::OnInitDialog()
{
CDialog::OnInitDialog();
// Add "About..." menu item to system menu.
// IDM_ABOUTBOX must be in the system command range.
ASSERT((IDM_ABOUTBOX & 0xFFF0) == IDM_ABOUTBOX);
ASSERT(IDM_ABOUTBOX < 0xF000);
CMenu* pSysMenu = GetSystemMenu(FALSE);
if (pSysMenu != NULL)
{
CString strAboutMenu;
strAboutMenu.LoadString(IDS_ABOUTBOX);
if (!strAboutMenu.IsEmpty())
{
pSysMenu->AppendMenu(MF_SEPARATOR);
pSysMenu->AppendMenu(MF_STRING, IDM_ABOUTBOX, strAboutMenu);
}
}
// Set the icon for this dialog. The framework does this automatically
// when the application's main window is not a dialog
SetIcon(m_hIcon, TRUE); // Set big icon
SetIcon(m_hIcon, FALSE); // Set small icon
// TODO: Add extra initialization here
m_Mstyle.InsertString(-1, "XY平面直線插補");
m_Mstyle.InsertString(-1, "XY平面圓弧插補(圓心、角度)");
m_Mstyle.InsertString(-1, "XY平面圓弧插補(終點、半徑、方向)");
m_Dir.InsertString(-1,"1 順時鐘");
m_Dir.InsertString(-1,"-1 逆時鐘");
Indenx[0]=IDC_EDIT_xcenter;
Indenx[1]=IDC_EDIT_ycenter;
Indenx[2]=IDC_EDIT_xendpos;
Indenx[3]=IDC_EDIT_yendpos;
Indenx[4]=IDC_EDIT_angle;
Indenx[5]=IDC_EDIT_radius;
Indenx[6]=IDC_COMBO_Dir;
// GT_Close();
GT_Open();
GT_Reset();
GT_SetSmplTm(200);
for(int i=1;i<5;i++)
{
GT_Axis(i);
GT_SetIntrMsk(0);
}
GT_LmtSns(255);
GT_EncSns(0x00);
for( i=1;i<5;i++)
{
GT_Axis(i);
GT_ClrSts();
GT_CtrlMode(0);
GT_CloseLp();
GT_SetKp(3);
GT_SetKi(0);
GT_SetKd(10);
GT_Update();
// GT_OpenLp();
GT_AxisOn();
GT_AuStpOn();
}
for(i=1;i<=3;i++)
{
GT_Axis(i);
GT_ClrSts();
GT_ZeroPos();
}
return TRUE; // return TRUE unless you set the focus to a control
}
void CCSUDlg::OnSysCommand(UINT nID, LPARAM lParam)
{
if ((nID & 0xFFF0) == IDM_ABOUTBOX)
{
CAboutDlg dlgAbout;
dlgAbout.DoModal();
}
else
{
CDialog::OnSysCommand(nID, lParam);
}
}
// If you add a minimize button to your dialog, you will need the code below
// to draw the icon. For MFC applications using the document/view model,
// this is automatically done for you by the framework.
void CCSUDlg::OnPaint()
{
if (IsIconic())
{
CPaintDC dc(this); // device context for painting
SendMessage(WM_ICONERASEBKGND, (WPARAM) dc.GetSafeHdc(), 0);
// Center icon in client rectangle
int cxIcon = GetSystemMetrics(SM_CXICON);
int cyIcon = GetSystemMetrics(SM_CYICON);
CRect rect;
GetClientRect(&rect);
int x = (rect.Width() - cxIcon + 1) / 2;
int y = (rect.Height() - cyIcon + 1) / 2;
// Draw the icon
dc.DrawIcon(x, y, m_hIcon);
}
else
{
CDialog::OnPaint();
}
}
// The system calls this to obtain the cursor to display while the user drags
// the minimized window.
HCURSOR CCSUDlg::OnQueryDragIcon()
{
return (HCURSOR) m_hIcon;
}
void CCSUDlg::OnBUTTONallzero() //坐標清零
{
for(int i=1;i<=3;i++)
{
GT_Axis(i);
GT_ClrSts();
GT_ZeroPos();
}
}
void CCSUDlg::OnBUTTONbeginrun() //開始動作(單段運行)
{
UpdateData(TRUE);
unsigned short sts;
double cnt1[5]={2000,0,0,0,0};
double cnt2[5]={0,2000,0,0,0};
GT_MapAxis(1,cnt1);
GT_MapAxis(2,cnt2);
GT_SetSynAcc(0.00001);
GT_SetSynVel(0.01);
switch(Mflag)
{
case 0: //直線
GT_LnXY(m_xendpos,m_yendpos);
GT_GetCrdSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetCrdSts(&sts);
}
MessageBox("運動完成","",MB_OK);
break;
case 1: //圓?。▓A心、角度)
GT_ArcXY(m_xcenter,m_ycenter,m_angle);
GT_GetCrdSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetCrdSts(&sts);
}
MessageBox("運動完成","",MB_OK);
break;
case 2: //圓弧(終點、半徑、方向)
int Dir=m_Dir.GetCurSel();
if(Dir==0)
Dir=1;
else
Dir=-1;
GT_ArcXYP(m_xendpos,m_yendpos,m_radius,Dir);
GT_GetCrdSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetCrdSts(&sts);
}
MessageBox("運動完成","",MB_OK);
break;
}
}
void CCSUDlg::OnBUTTONcircle()
{
CArcDlg *pCArcDlg;
pCArcDlg=new CArcDlg(this);
this->ShowWindow(0);
pCArcDlg->DoModal();
delete pCArcDlg;
this->ShowWindow(1);
}
void CCSUDlg::OnBUTTONdot()
{
CDotDlg *pCDotDlg;
pCDotDlg=new CDotDlg(this);
this->ShowWindow(0);
pCDotDlg->DoModal();
delete pCDotDlg;
this->ShowWindow(1);
}
void CCSUDlg::OnBUTTONline()
{
CLineDlg *pCLineDlg;
pCLineDlg=new CLineDlg(this);
this->ShowWindow(0);
pCLineDlg->DoModal();
delete pCLineDlg;
this->ShowWindow(1);
}
void CCSUDlg::OnBUTTONxminus() //X-(手動操作)
{
UpdateData(TRUE);
flag=-1;
GT_Axis(1);
GT_ClrSts();
Tmotion(m_enter, m_speed);
}
void CCSUDlg::OnBUTTONxmzero() //X負向回零
{
unsigned short sts;
GT_Axis(1);
GT_ClrSts();
GT_PrflT();
GT_SetPos(-1000000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x40)!=0x40)
{
GT_GetSts(&sts);
}
Sleep(20);
GT_ZeroPos();
GT_SetPos(1000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetSts(&sts);
}
GT_ClrSts();
MessageBox("回零完成","Complete",MB_OK);
}
void CCSUDlg::OnBUTTONxplus() //X+(手動操作)
{
UpdateData(TRUE);
flag=1;
GT_Axis(1);
GT_ClrSts();
Tmotion(m_enter, m_speed);
}
void CCSUDlg::OnBUTTONxpzero() //X正向回零
{
unsigned short sts;
GT_Axis(1);
GT_ClrSts();
GT_PrflT();
GT_SetPos(1000000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x20)!=0x20)
{
GT_GetSts(&sts);
}
Sleep(20);
GT_ZeroPos();
GT_SetPos(-1000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetSts(&sts);
}
GT_ClrSts();
MessageBox("回零完成","Complete",MB_OK);
}
void CCSUDlg::OnBUTTONyminus() //Y-(手動操作)
{
UpdateData(TRUE);
flag=-1;
GT_Axis(2);
GT_ClrSts();
Tmotion(m_enter, m_speed);
}
void CCSUDlg::OnBUTTONymzero() //Y負向回零
{
unsigned short sts;
GT_Axis(2);
GT_ClrSts();
GT_PrflT();
GT_SetPos(-1000000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x40)!=0x40)
{
GT_GetSts(&sts);
}
Sleep(20);
GT_ZeroPos();
GT_SetPos(1000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetSts(&sts);
}
GT_ClrSts();
MessageBox("回零完成","Complete",MB_OK);
}
void CCSUDlg::OnBUTTONyplus() //Y+(手動操作)
{
UpdateData(TRUE);
flag=1;
GT_Axis(2);
GT_ClrSts();
Tmotion(m_enter, m_speed);
}
void CCSUDlg::OnBUTTONypzero() //Y正向回零
{
unsigned short sts;
GT_Axis(2);
GT_ClrSts();
GT_PrflT();
GT_SetPos(1000000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x20)!=0x20)
{
GT_GetSts(&sts);
}
Sleep(20);
GT_ZeroPos();
GT_SetPos(-1000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetSts(&sts);
}
GT_ClrSts();
MessageBox("回零完成","Complete",MB_OK);
}
void CCSUDlg::OnBUTTONzminus() //Z-(手動操作)
{
UpdateData(TRUE);
flag=-1;
GT_Axis(3);
GT_ClrSts();
Tmotion(m_enter, m_speed);
}
void CCSUDlg::OnBUTTONzmzero() //Z負向回零
{
unsigned short sts;
GT_Axis(3);
GT_ClrSts();
GT_PrflT();
GT_SetPos(-1000000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x40)!=0x40)
{
GT_GetSts(&sts);
}
Sleep(20);
GT_ZeroPos();
GT_SetPos(1000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetSts(&sts);
}
GT_ClrSts();
MessageBox("回零完成","Complete",MB_OK);
}
void CCSUDlg::OnBUTTONzplus() //Z+(手動操作)
{
UpdateData(TRUE);
flag=1;
GT_Axis(3);
GT_ClrSts();
Tmotion(m_enter, m_speed);
}
void CCSUDlg::OnBUTTONzpzero() //Z正向回零
{
unsigned short sts;
GT_Axis(3);
GT_ClrSts();
GT_PrflT();
GT_SetPos(1000000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x20)!=0x20)
{
GT_GetSts(&sts);
}
Sleep(20);
GT_ZeroPos();
GT_SetPos(-1000);
GT_SetVel(10);
GT_SetAcc(0.1);
GT_Update();
GT_GetSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetSts(&sts);
}
GT_ClrSts();
MessageBox("回零完成","Complete",MB_OK);
}
void CCSUDlg::Tmotion(double Pos, double speed)
{
long d1=(long)(Pos*Pmm);//位置
double d2=speed*Vmms;//速度
if(d2>=16384||d2<=0)
{
MessageBox("速度超出范圍","error",MB_OK);
}
if(d1>=1073741823||d2<=-1073741824)
{
MessageBox("增量值超出范圍","error",MB_OK);
}
if(flag==-1)
d1=-d1;
GT_PrflT();
GT_SetAcc(0.4);
GT_SetVel(d2);
GT_SetPos(d1);
GT_Update();
unsigned short sts;
GT_GetSts(&sts);
while((sts&0x01)!=0x01)
{
GT_GetSts(&sts);
}
GT_ClrSts();
GT_ZeroPos();
}
void CCSUDlg::OnSelchangeCOMBOMStyle()
{
UpdateData(TRUE);
int index = m_Mstyle.GetCurSel();
CEdit *c;
int i=0;
switch(index)
{
case 1: //圓心、角度
for(;i<7;i++)
{
c = ( CEdit *)GetDlgItem(Indenx[i]);
if(i!=0&&i!=1&&i!=4)
c->SetReadOnly(TRUE);
else
{
c->SetReadOnly(FALSE);
m_Dir.EnableWindow(FALSE);
}
}
Mflag=1;
break;
case 2: //終點、半徑、方向
for(;i<7;i++)
{
c = ( CEdit *)GetDlgItem(Indenx[i]);
if(i!=2&&i!=3&&i!=5&&i!=6)
{
c->SetReadOnly(TRUE);
m_Dir.EnableWindow(TRUE);
}
else
c->SetReadOnly(FALSE);
}
Mflag=2;
break;
case 0: //直線插補
for(;i<7;i++)
{
c = ( CEdit *)GetDlgItem(Indenx[i]);
if(i!=2&&i!=3)
c->SetReadOnly(TRUE);
else
{
c->SetReadOnly(FALSE);
m_Dir.EnableWindow(FALSE);
}
}
Mflag=0;
break;
default:
break;
}
}
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -