debug.cpp

这是在windows环境下用VC开发的MCX运动控制芯片的演示程序

// 控制y轴的微动
#include "driver.h"

void main()
{
	char ch;
	long data0, data1 = 0, data2, data3, ret1, ret2;
	long data4;
	clrscr();
	InitialBoard();

	SetWR1(1, 0x80);
	SetWR2(1, 0x800);

	DRVLIST &b = GetDrvList();
	SetM(1, 10);
	//*
	b.sv[0] = 30;
	b.v[0] = 2000;
	b.a[0] = 160;
	b.p[0] = 60000;
	UpdateDrvData(1);//*/
	/*
	SetSV(1, 30);
	SetV(1, 500);
	SetA(1, 160);
	SetP(1, 60000);//*/
	Command(1, DRIVE_N);

	unsigned char flag;
	data1 = 0;
	data4 = 0;
	/*
	do
	{
		ret1 = ReadEP(1);
		ret2 = ReadLP(1);
		data2 = ReadCV(1);
		flag = GetRR0();
		data0 = GetRR4();
		data3 = GetRR1(1);
		//cout << "RR1=" << data3 << "  ";
		//cout << "EP=" << ret1 << "  LP=" << ret2 << "  CV=" << data2 << endl;
		if (!(data0 & 0x4))
		{
			if (fabs(ret1 - data4) > 10)
			{
			data1 ++;
			data4 = ret1;
			}
		}
	}
	while (flag & 0x1);
	cout << "D=" << data1 << endl;*/
	WaitForStop(1);
	CSVLIST &c = GetCurStatus(1);
	cout << "EP=" << c.ep[0] << "  LP=" << c.lp[0] << endl;
	cout << "CV=" << VToSpeed(1, c.cv[0]) << "  CA=" << AToAcc(1, c.ca[0]) <<endl;
	//ret1 = ReadEP(1);
	//ret2 = ReadLP(1);
	//cout << "EP=" << ret1 << "  LP=" << ret2 << endl;
	getch();
}