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]); } } }