#include "PacketId.h" #include "Vertex.h" #include Vertex lastPos=Vertex(0,0,0); bool canSet=false; bool ExtraProcessing(unsigned short header, unsigned char* pPacket) { //GW processes the opcode as an int32 pPacket+=2; //Check for start movement packet if (header == 0x0150) { Log("\nStart: \n"); canSet=true; } else if (header == 0x001e) { unsigned long agId=0; float unknown=0; unsigned char u2=0; memcpy(&agId, pPacket+2, 4); memcpy(&unknown, pPacket+6, 4); memcpy(&u2, pPacket+10, 1); Vertex p=Vertex(unknown, 0, 0); p=p.Normalize(); Log("mStop: AgId=%u, %f, %u\n", agId, p.x, u2); } else if (header == 0x001c) { unsigned long agId=0; Vertex pos; memcpy(&agId, pPacket+2, 4); memcpy(&pos.x, pPacket+4, 4); memcpy(&pos.y, pPacket+8, 4); memcpy(&pos.z, pPacket+12, 4); if (lastPos.x != 0) { Vertex oldPos=lastPos.Normalize(); Vertex newPos=pos.Normalize(); float rot=acos(newPos.DotProd(oldPos)); short deg=rot*(180.0/3.14159); //Log("GL: agId=%u Dist: %f Rot: %u\n", agId, pos.Distance(lastPos), deg); } if (canSet) { lastPos=pos; canSet=false; } } else if (header == 0x001b) { Log("WE GOT 1B!\n"); } else if (header == 0x0021) { unsigned long agId=0; memcpy(&agId, pPacket+2, 4); float rot=0; memcpy(&rot, pPacket+6, 4); float un=0; memcpy(&un, pPacket+10, 4); Log("AgId=%u, Rot: %f, Un: %f\n", agId, rot, un); } else { return false; } return true; }