Ejemplo n.º 1
0
void SensorKeepAliveImpl::Pack()
{
    Buffer[0] = 8;
    Buffer[1] = UByte(CommandId & 0xFF);
    Buffer[2] = UByte(CommandId >> 8);
    Buffer[3] = UByte(KeepAliveIntervalMs & 0xFF);
    Buffer[4] = UByte(KeepAliveIntervalMs >> 8);
}
Ejemplo n.º 2
0
void SensorConfigImpl::Pack()
{
    Buffer[0] = 2;
    Buffer[1] = UByte(CommandId & 0xFF);
    Buffer[2] = UByte(CommandId >> 8);
    Buffer[3] = Flags;
    Buffer[4] = UByte(PacketInterval);
    Buffer[5] = UByte(SampleRate & 0xFF);
    Buffer[6] = UByte(SampleRate >> 8);
}
Ejemplo n.º 3
0
void SensorRangeImpl::Pack()
{
    Buffer[0] = 4;
    Buffer[1] = UByte(CommandId & 0xFF);
    Buffer[2] = UByte(CommandId >> 8);
    Buffer[3] = UByte(AccelScale);
    Buffer[4] = UByte(GyroScale & 0xFF);
    Buffer[5] = UByte(GyroScale >> 8);
    Buffer[6] = UByte(MagScale & 0xFF);
    Buffer[7] = UByte(MagScale >> 8);
}
    void Pack()
    {
        Buffer[0] = 5;
		Buffer[1] = UByte(Configuration.SendSamples);
		Buffer[2] = Configuration.Threshold.R;
        Buffer[3] = Configuration.Threshold.G;
        Buffer[4] = Configuration.Threshold.B;
    }
Ejemplo n.º 5
0
//------------------------------------------------------------------------------
int genTri2(UByte pntCnt,PntDef* pntArray,UByte* orgPolyDesc,UByte*& triangleList)
{
	int totalFans=0;
	UByte* pTri=triangleList;	//place to store triangle fan data
	int pointsLeft=pntCnt;

	UByte* localPoly=new UByte[pointsLeft];
	UByte* swapPoly=new UByte[pointsLeft];

	for (int x=0;x<pointsLeft;localPoly[x]=orgPolyDesc[x],x++) {}

	int fanMin=2; //minimum no of triangles allowed in a fan
	int p0=0;
	int testCnt=0;
	abortNow=FALSE;

	while (pointsLeft>3 && !abortNow)
	{
		int p1=(p0+1)%pointsLeft;
		int p2=(p0+2)%pointsLeft;
		int fanCount=0;

		//try to make as large a fan as possible
		while (CheckTri(pointsLeft,localPoly,pntArray,p0,p1,p2))
		{
			fanCount++;
			p1=p2;
			p2=(p1+1)%pointsLeft;
		}
		//Check to see if we've generated a fan properly

		if (fanCount>=fanMin)
		{
			globalTriCount+=fanCount;
			//Add this fan to the list
			*pTri++=UByte(fanCount);
			for (int x=0;x<fanCount+2;x++) *pTri++=localPoly[(p0+x)%pointsLeft];

			//remove points that are no longer required
			UByte* tmp=swapPoly;
			for (x=p1;x!=p0;x=(x+1)%pointsLeft) *tmp++=localPoly[x];
			*tmp++=localPoly[x]; 	
			tmp=swapPoly; swapPoly=localPoly; localPoly=tmp;
			p0=0;
			testCnt=0;
			fanMin=2;
			pointsLeft-=fanCount;
			totalFans++;
		}
		else
		{
		 	p0=(p0+1)%pointsLeft;
			testCnt++;			//number of tests done with no fans produced

			if (testCnt==pointsLeft)
			{
				testCnt=0;
				if (fanMin==2)	fanMin=1;
				else			abortNow=TRUE;
			}
		}
	}

	if (pointsLeft==3&&!abortNow)
	{
		//add the last single triangle
		*pTri++=UByte(1);				//fan of 1 triangle
		*pTri++=localPoly[0];
		*pTri++=localPoly[1];
		*pTri++=localPoly[2];

		totalFans++;
	}
	delete[]localPoly;
	delete[]swapPoly;

	triangleList=pTri;
	return totalFans;
}