public void updateController(Device dev, int id)
{
// MojingLog.LogTrace("dev: " + dev.name+ ", weapon: "+ weapon.name);
if (null != dev)
{
dev.connected = true;
//MojingLog.LogTrace("dev.connected: " + dev.connected);
if (!dev.connected)
{ // 设备没有连上，先进行连接
MojingLog.LogTrace("connectDevice: " + connectDevice(dev.id) + ", dev.id: " + dev.id);
if (connectDevice(dev.id))
{
dev.connected = true;
}
}
else
{ // 连接上了，更新设备位置
//MojingSDK.Unity_Device_GetInfo(dev.id, _quartArray, _angularArray, _linearArray, _posArray, _keyAray);
MojingSDK.Unity_Device_GetFixCurrentInfo(dev.id, _quartArray, _angularArray, _linearArray, _posArray, _keyAray);
QuartArray[id] = new Quaternion(_quartArray[0], _quartArray[1], _quartArray[2], _quartArray[3]);
AngularArray[id] = new Vector3(_angularArray[0], _angularArray[1], _angularArray[2]);
LinearArray[id] = new Vector3(_linearArray[0], _linearArray[1], _linearArray[2]);
//Debug.Log("ID: " + dev.id + "Quaternion:" + QuartArray[id]
// + "\n" + "angularArray:" + AngularArray[id]
// + "\n" + "angularArray:" + LinearArray[id]);
MojingSDK.Unity_Device_GetFixInfo(dev.id, _quartArray, _angularArray, _linearArray, _posArray);
FixQuate[id] = new Quaternion(_quartArray[0], _quartArray[1], _quartArray[2], _quartArray[3]);
}
}
}
