mfcbatchmovedlg.cpp

介绍控制器运动的例子

// MFCBatchMoveDlg.cpp : implementation file
//

#include "stdafx.h"
#include "MFCBatchMove.h"
#include "MFCBatchMoveDlg.h"
#include "Text_FILE.h"
#include "KTags.h"
#include <math.h>

#ifdef _DEBUG
#define new DEBUG_NEW
#undef THIS_FILE
static char THIS_FILE[] = __FILE__;
#endif

/////////////////////////////////////////////////////////////////////////////
// CMFCBatchMoveDlg dialog

CMFCBatchMoveDlg::CMFCBatchMoveDlg(CWnd* pParent /*=NULL*/)
	: CDialog(CMFCBatchMoveDlg::IDD, pParent)
{
	//{{AFX_DATA_INIT(CMFCBatchMoveDlg)
	m_MoveFileName = _T("D:\\Applications\\ACR Tools\\BoxBridgeSamples\\MFCBatchMove\\Debug\\moves.cmp");
	m_MoveLbl = _T("0 Moves Loaded");
	m_Transport = 2;
	m_BusType = FALSE;
	m_BPS = 38400;
	m_CardNbr = 0;
	m_IP = _T("0.0.0.0");
	m_Port = 1;
	m_Ver = _T("v?.?.?.?");
	m_lblConnected = _T("Disconnected");
	m_CmdDiff = 0;
	m_CmdMsec = 0;
	m_CmdStart = 0;
	m_CmdEnd = 0;
	//}}AFX_DATA_INIT
	// Note that LoadIcon does not require a subsequent DestroyIcon in Win32
	m_hIcon = AfxGetApp()->LoadIcon(IDR_MAINFRAME);

  // Create Interfaces using Prog ID
  m_Cntl = new IControl;
  m_Cntl->CreateDispatch(_T("BoxBridge.Control.1"));
  // Initialize working data
  pSAz = NULL;
  m_TargetTypeLong = true;
  _LARGE_INTEGER x;
  QueryPerformanceFrequency(&x);    // counts per second for timer
  m_secPCtic = x.QuadPart * 0.001;  // use this number to calculate msec for PC counter

}

CMFCBatchMoveDlg::~CMFCBatchMoveDlg()
{
  // Need to Clean up COM
  if(m_Cntl){
    m_Cntl->Disconnect();
    delete m_Cntl;
  }
  // CoUninitialize();       // Clean up of COM done automatically by MFC
}

void CMFCBatchMoveDlg::DoDataExchange(CDataExchange* pDX)
{
	CDialog::DoDataExchange(pDX);
	//{{AFX_DATA_MAP(CMFCBatchMoveDlg)
	DDX_Text(pDX, IDC_MOVE_FILE, m_MoveFileName);
	DDX_Text(pDX, IDC_NBR_MOVES, m_MoveLbl);
	DDX_Radio(pDX, IDC_RDO_TRANSPORT, m_Transport);
	DDX_Check(pDX, IDC_CHK_PCI, m_BusType);
	DDX_Text(pDX, IDC_TXT_BPS, m_BPS);
	DDX_Text(pDX, IDC_TXT_CARDNBR, m_CardNbr);
	DDX_Text(pDX, IDC_TXT_IP, m_IP);
	DDX_Text(pDX, IDC_TXT_PORT, m_Port);
	DDX_Text(pDX, IDC_LBL_VER, m_Ver);
	DDX_Text(pDX, IDC_LBL_CON, m_lblConnected);
	DDX_Text(pDX, IDC_BATCH_DIFF, m_CmdDiff);
	DDX_Text(pDX, IDC_BATCH_MSEC, m_CmdMsec);
	DDX_Text(pDX, IDC_BATCH_START, m_CmdStart);
	DDX_Text(pDX, IDC_BATCH_END, m_CmdEnd);
	//}}AFX_DATA_MAP
}

BEGIN_MESSAGE_MAP(CMFCBatchMoveDlg, CDialog)
	//{{AFX_MSG_MAP(CMFCBatchMoveDlg)
	ON_WM_PAINT()
	ON_WM_QUERYDRAGICON()
	ON_BN_CLICKED(IDC_LOAD_BATCH, OnLoadBatch)
	ON_BN_CLICKED(IDC_BTN_CONNECT, OnBtnConnect)
	ON_BN_CLICKED(IDC_SEND_BATCH, OnSendBatch)
	//}}AFX_MSG_MAP
END_MESSAGE_MAP()

/////////////////////////////////////////////////////////////////////////////
// CMFCBatchMoveDlg message handlers

BOOL CMFCBatchMoveDlg::OnInitDialog()
{
	CDialog::OnInitDialog();

	// 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
	
	return TRUE;  // return TRUE  unless you set the focus to a control
}

// 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 CMFCBatchMoveDlg::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 CMFCBatchMoveDlg::OnQueryDragIcon()
{
	return (HCURSOR) m_hIcon;
}

void CMFCBatchMoveDlg::OnLoadBatch() 
{
  UpdateData();
  // Load moves from a file
  Text_FILE moveFile((LPCSTR)m_MoveFileName);
  string wholeFile;
  long cnt;
  SAFEARRAYBOUND bound[1];

  while(!moveFile.isEOR())
    wholeFile += moveFile.readLn();

  KTags tagWholeFile(wholeFile,MOVE_TAG_START,MOVE_TAG_END);

  long totalMoves = tagWholeFile.count(MOVE_TAG);
  KzStr sTotalMoves(totalMoves);
  m_MoveLbl = CString(sTotalMoves.str().c_str()) + " Moves Loaded";
  bound[0].lLbound=0;
  bound[0].cElements=totalMoves*32;
  if(pSAz)
    SafeArrayDestroy(pSAz);
  pSAz = SafeArrayCreate(VT_VARIANT,1,bound);
  lsym.clear();

  for(long mvNbr=0; mvNbr<totalMoves; ++mvNbr){
    // Fill each array value for the current move
    KTags oneMove(tagWholeFile.token(MOVE_TAG,mvNbr),MOVE_TAG_START,MOVE_TAG_END);

    // Headers
    for(cnt=0; cnt<8; ++cnt){
      lsym.push_back(getBinVal(oneMove.token(MOVE_TAG_CODE,cnt)));
    }

    // Speed
    lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_VEL)));
    lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_FVEL)));
    lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_ACC_DEC)));

    // Targets
    if(oneMove.token(MOVE_TAG_TYPE) == "1")
      m_TargetTypeLong = false;

    for(cnt=0; cnt<16; ++cnt){
      if(m_TargetTypeLong)
        lsym.push_back(getLongVal(oneMove.token(MOVE_TAG_AXIS,cnt)));
      else
        lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_AXIS,cnt)));
    }

    // Arc
    if(m_TargetTypeLong){
      lsym.push_back(getLongVal(oneMove.token(MOVE_TAG_PRI_CENTER)));
      lsym.push_back(getLongVal(oneMove.token(MOVE_TAG_SEC_CENTER)));
    }else{
      lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_PRI_CENTER)));
      lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_SEC_CENTER)));
    }

    // Scale
    lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_PRI_SCALE)));
    lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_SEC_SCALE)));
    lsym.push_back(getFloatVal(oneMove.token(MOVE_TAG_VECTOR)));
  }

  long t = lsym.size();

  UpdateData(FALSE);

}

void CMFCBatchMoveDlg::OnBtnConnect() 
{
  //******************
  // Connect to the Device on control interface
  UpdateData();

  m_Ver = CString("v") + m_Cntl->GetBstrVersion();  // Version

  m_Cntl->SetNBPS(m_BPS);               // Set BPS
  m_Cntl->SetNPort(m_Port);             // Set Port
  m_Cntl->SetBstrIP(m_IP);              // Set IP Address
  m_Cntl->SetNBus(m_BusType?1:0);       // Set Bus, checked(true) is ISA, else PCI
  m_Cntl->Connect(m_Transport,m_CardNbr);//Connect to Transport
  m_CardNbr = m_Cntl->GetNCard();       // One way to use USB is to grab the first unit, but then need to directly connect after that

  if(!m_Cntl->GetIsOffline()){ // Verify Connection
    m_lblConnected = _T("Connected");
  }

  UpdateData(FALSE);
	
}

void CMFCBatchMoveDlg::OnSendBatch() 
{
  UpdateData();

  VARIANT symbol;
  _LARGE_INTEGER StartTic;
  _LARGE_INTEGER EndTic;
  long mvType = m_TargetTypeLong?0:2;

  for(long i=0; i<lsym.size(); ++i)
    SafeArrayPutElement(pSAz, &i, &lsym.at(i));
  VariantInit(&symbol);
  symbol.vt = VT_ARRAY | VT_VARIANT;
  symbol.parray = pSAz;

  QueryPerformanceCounter(&StartTic);
  m_Cntl->MoveBatch(mvType,symbol);
  QueryPerformanceCounter(&EndTic);
  m_CmdDiff = EndTic.QuadPart - StartTic.QuadPart;
  m_CmdMsec = m_CmdDiff / m_secPCtic;
	m_CmdStart = StartTic.QuadPart;
	m_CmdEnd = EndTic.QuadPart;


  UpdateData(FALSE);
	
}

long CMFCBatchMoveDlg::getBinVal(KzStr con)
{
  long val = 0;
  con.toHEX(1);
  for(int i=con.cntHEX()-1; i>=0; --i){
    val += (pow(2,i))*con.getHEX(i);
  }
  return val;
}

long CMFCBatchMoveDlg::getLongVal(KzStr con)
{
  return con.whole();
}

float CMFCBatchMoveDlg::getFloatVal(KzStr con)
{
  return con.real();
}