point.c

来自「用电键控制步进电机朝各个方向做曲线」· C语言 代码 · 共 56 行

#include "reg52.h"
#include "intrins.h"
#include "math.h"
int point_A (int x,int y)
{
	int lineA;
	float tmp;
	tmp=(115-y)*(115-y)+(x+15)*(x+15);
	tmp=sqrt(tmp);
	lineA=tmp;
	return lineA;
}

int point_B (int x,int y) 
{
	int lineB;
	float tmp;
	tmp=(115-y)*(115-y)+(95-x)*(95-x);
	tmp=sqrt(tmp);
	lineB=tmp;
	return lineB;
}

int loc_X (int lineA,int lineB)
{
	int loc;
	loc = (lineA*lineA-lineB*lineB)/220+40;
	return loc;
}


void circle (int x,int y)
{
	int i;
	int x1,y1;
	int linex,liney;
	float tmp1,tmp2;
	
	x1=x;
	y1=y;

	for (i=0;i<360;i+=5)
		{
    	//取绝对坐标
    	tmp1=sin(3.1415926*(1-i/180));
		tmp2=cos(3.1415926*(1-i/180));

		x1=x1+(x1+25)*tmp2;
		y1=y1+25*tmp1;
		linex=point_A(x1,y1);
		liney=point_B(x1,y1);

//		electr(linex,liney);
		}
}