help with moving

unsigned long double calcRange(Coord a,Coord b)
{
	DWORD difx,dify;
	unsigned long double range;
	difx=a.X-b.X;
	dify=a.Y-b.Y;

	range=(difx*difx)+(dify*dify);
	if(range<0) { printf("Error while Range-Calc\n");range=4294967294; }

	//printf("\nBefore Sqrt: %lf",range);
	range=sqrt(range);
	//printf("\nAfter Sqrt: %lf\n",range);
	//printf("A: %d %d \nB: %d %d   --> %lf\n",a.X,a.Y,b.X,b.Y,range);
	
	return range;
}

void makeStepTo(Coord target)
{
	//double range=(double)calcRange(player.pos,target);
	int difx=player.pos.X-target.X;
	int dify=player.pos.Y-target.Y;
	int difz=player.pos.Z-(target.Z-underground);
	int tempx=-difx;
	int tempy=-dify;
	int tempz=-difz;
	//unsigned char moveX, moveY;
	if(tempx>20) { tempx=20; }
	if(tempx<-20) { tempx=-20; }
	if(tempy>20) { tempy=20; }
	if(tempy<-20) { tempy=-20; }
	if(tempz>20) { tempz=20; }
	if(tempz<-20) { tempz=-20; }
	if(tempx<0)
	{
		tempx=255+tempx;
	}
	if(tempy<0)
	{
		tempy=255+tempy;
	}
	if(tempz<0)
	{
		tempz=255+tempz;
	}

	if(target.Z==0) { tempz=0; }

	SendPacket(0x15,"bbb",tempx,tempy,tempz);
}

bool walkToCoord(Coord target, int speed,unsigned long double range, int timeout)
{
	//Normal Walk Speed =500
	//Speed Walk ~ 300
	printf("Walk to X:%d Y:%d, Z:%d\n",target.X,target.Y,target.Z);
	for(int i=0;calcRange(player.pos,target)>range;++i)
	{
		if(timeout>0 && i>timeout) { printf("Error. Timeout.\n"); return false;}
		makeStepTo(target);
		Sleep(speed);
		printf(".");
	}
	
	printf("\n");
	return true;
}