dmctest.cpp

基于DMC1410卡的运动控制编程示例,本示例介绍了用dmc1410卡如何实现一个简单的运动控制

#include"mem.h"
#include"stdio.h"
#include"stdlib.h"
#include"dos.h"
#include"bios.h"
#include"string.h"
#include"time.h"

#include"math.h"
#include"dmc4104.h"
#include"conio.h"
void main()
{
      double m_speed;
      int m_key;
      clrscr();
      int i= d4104_board_init();
      d4104_set_position(0,0);
      d4104_set_position(1,0);
      d4104_set_position(2,0);
      d4104_set_position(3,0);
      d4104_variety_speed_range(0,1,500000);
      d4104_set_profile(0,100,1000,0.1,0.1);
      d4104_t_vmove(0,1);
      m_key=0;

      /*
      while(m_key!=0x1)
      {
	if(!bioskey(1))	m_key=bioskey(0)>>8;
	gotoxy(40,10);
	printf("m_key=%d   ",m_key);
	m_key &=0xff;
      }
      */
      while(m_key!=0x1) //'ESC' end while
      {
	gotoxy(10,10);
	m_speed=d4104_current_speed(0);
	printf("m_speed=%0.3f",m_speed);
	gotoxy(10,13);
	printf("Position=%ld",d4104_get_position(0));
	if(!bioskey(1))	m_key=bioskey(0)>>8;
	switch(m_key)
	{
	case 59:   //"F1" change speed
	   d4104_change_speed(0,m_speed+100);
	   m_key=0;
	   break;
	default:break;
	}
	//for(i=1;i<=8;i++)

	//printf("%d ", d4104_read_inbit(i));
      }
      d4104_decel_stop(0,0.1);
}