Esempio n. 1
0
        public void AcceptConnectionRequest(ulong bdAddr, byte role)
        {
            var data = new byte[7];

              data[0] = (byte)(bdAddr & 0xFF);
              data[1] = (byte)((bdAddr & 0xFF00) >> 8);
              data[2] = (byte)((bdAddr & 0xFF0000) >> 16);
              data[3] = (byte)((bdAddr & 0xFF000000) >> 24);
              data[4] = (byte)((bdAddr & 0xFF00000000) >> 32);
              data[5] = (byte)((bdAddr & 0xFF0000000000) >> 40);
              data[6] = role;

              var opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.AcceptConnectionRequest);
              _SendHCICommand(opcode, data, true);
        }
Esempio n. 2
0
        private void _SendHCICommand(Opcode command, byte[] parameterData, bool returnImmediately)
        {
            var cmdData = new byte[3 + (parameterData != null ? parameterData.Length : 0)];
              var packet = new UsbSetupPacket(0x20, 0x00, 0x0000, 0x0000, (short)cmdData.Length);

              cmdData[0] = (byte)(command.Data & 0xFF);
              cmdData[1] = (byte)((command.Data >> 8) & 0xFF);
              if (parameterData != null && parameterData.Length > 0)
              {
            cmdData[2] = (byte)parameterData.Length;
            for (int i = 0; i < parameterData.Length; i++)
              cmdData[3 + i] = parameterData[i];
              }

              int transferred;
              _device.ControlTransfer(ref packet, cmdData, cmdData.Length, out transferred);
              if (transferred != cmdData.Length)
            throw new InvalidOperationException(String.Format("Failed to send command; sent {0} bytes instead of {1}",
              transferred, cmdData.Length));

              if (!returnImmediately)
              {
            //Wait for command to complete
            _WaitForCompletion(command);
              }
        }
Esempio n. 3
0
        private void _WaitForCompletion(Opcode command)
        {
            while (true)
              {
            lock (_completedCommands)
            {
              if (_completedCommands.Contains(command))
              {
            _completedCommands.Remove(command);
            break;
              }
            }

            Thread.Sleep(10);
              }
        }
Esempio n. 4
0
 private void _SendHCICommand(Opcode command, bool returnImmediately)
 {
     _SendHCICommand(command, null, returnImmediately);
 }
Esempio n. 5
0
 private void _SendHCICommand(Opcode command, byte[] parameterData)
 {
     _SendHCICommand(command, parameterData, false);
 }
Esempio n. 6
0
        private void hci_DataReceived(object sender, EndpointDataEventArgs e)
        {
            switch ((HCIEvent)e.Buffer[0])
              {
            case HCIEvent.InquiryComplete:
              {
            lock (_completedCommands)
            {
              _completedCommands.Add(new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.Inquiry));
            }

            break;
              }
            case HCIEvent.InquiryResult:
              {
            var opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.Inquiry);
            if (!_commandData.ContainsKey(opcode)) _commandData.Add(opcode, new List<InquiryResult>());
            var list = _commandData[opcode] as List<InquiryResult>;

            int responses = Convert.ToInt32(e.Buffer[2]);
            int offset = 3;
            for (int i = 0; i < responses; i++)
            {
              list.Add(new InquiryResult(Utilities.GetLEULong(e.Buffer, offset + 0, 6), e.Buffer[offset + 6],
                e.Buffer[offset + 7], e.Buffer[offset + 8], (uint)Utilities.GetLEULong(e.Buffer, offset + 9, 3),
                (ushort)Utilities.GetLEULong(e.Buffer, offset + 12, 2)));
              offset += 14;
            }

            break;
              }
            case HCIEvent.ConnectionComplete:
              {
            Logger.WriteLine("Connection Complete, Status: " + e.Buffer[2].ToString("X2"));
            ushort connectionHandle = (ushort)(e.Buffer[3] | (e.Buffer[4] << 8));
            ulong bdAddr = Utilities.GetLEULong(e.Buffer, 5, 6);

            //Raise event out
            if (ConnectionComplete != null)
              ConnectionComplete(this, new HCIEventEventArgs(e.Buffer, e.Count));

            break;
              }
            case HCIEvent.DisconnectionComplete:
              {
            Logger.WriteLine("Disconnection Complete, Status: " + e.Buffer[2].ToString("X2"));

            break;
              }
            case HCIEvent.ConnectionRequest:
              {
            var bdAddr = Utilities.GetLEULong(e.Buffer, 2, 6);
            var deviceClass = Utilities.GetLEULong(e.Buffer, 8, 3);
            byte linkType = e.Buffer[11];
            Logger.WriteLine(String.Format("Connection Request Received, BD_ADDR {0}, class {1}, link type {2}",
              bdAddr.ToString("X12"), deviceClass.ToString("X6"), linkType.ToString("X2")));

            //Accept this request (or do whatever with it)
            if (ConnectionRequestReceived != null)
              ConnectionRequestReceived(this, new HCIEventEventArgs(e.Buffer, e.Count));

            break;
              }
            case HCIEvent.RemoteNameRequestComplete:
              {
            var opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.RemoteNameRequest);
            if (!_commandData.ContainsKey(opcode))
              _commandData.Add(opcode, ASCIIEncoding.ASCII.GetString(e.Buffer, 9, 248).Trim(new char[] {'\0'} ));

            lock (_completedCommands)
            {
              _completedCommands.Add(opcode);
            }

            break;
              }
            case HCIEvent.QoSSetupComplete:
              {
            Logger.WriteLine("QoS Setup Complete");

            break;
              }
            case HCIEvent.Complete:
              {
            var command = new Opcode(e.Buffer, 3);

            lock (_completedCommands)
            {
              _completedCommands.Add(command);
            }

            break;
              }
            case HCIEvent.Status:
              {
            var command = new Opcode(e.Buffer, 4);

            break;
              }
            case HCIEvent.PINCodeRequestEvent:
              {
            var bdAddr = Utilities.GetLEULong(e.Buffer, 2, 6);

            //Send the reply
            SendPINCodeReply(bdAddr, String.Empty);

            break;
              }
            default:
              {
            //Uh?
            Logger.WriteLine("Unknown HCI event: " + e.Buffer[0].ToString("X2"));

            break;
              }
              }
        }
Esempio n. 7
0
 private void _SendHCICommand(Opcode command)
 {
     _SendHCICommand(command, false);
 }
Esempio n. 8
0
 public void SetDiscoverableMode(bool discoverable)
 {
     var opcode = new Opcode(OpcodeGroupField.HCBaseband, OpcodeCommandField.WriteScanEnable);
       _SendHCICommand(opcode, new byte[] {discoverable ? (byte)0x03 : (byte)0x01});
 }
Esempio n. 9
0
        public void SetLocalName(string name)
        {
            var data = new byte[name.Length + 1];
              Array.Copy(ASCIIEncoding.ASCII.GetBytes(name), data, name.Length);

              var opcode = new Opcode(OpcodeGroupField.HCBaseband, OpcodeCommandField.WriteLocalName);
              _SendHCICommand(opcode, data);
        }
Esempio n. 10
0
        public void SetDeviceClass(uint deviceClass)
        {
            var data = new byte[3];

              data[0] = (byte)(deviceClass & 0xFF);
              data[1] = (byte)((deviceClass >> 8) & 0xFF);
              data[2] = (byte)((deviceClass >> 16) & 0xFF);

              var opcode = new Opcode(OpcodeGroupField.HCBaseband, OpcodeCommandField.WriteDeviceClass);
              _SendHCICommand(opcode, data);
        }
Esempio n. 11
0
        //NOTE: This doesn't work if you send a PIN, not sure why.
        public void SendPINCodeReply(ulong bdAddr, string pin)
        {
            Opcode opcode;
              var data = new byte[6 + (String.IsNullOrEmpty(pin) ? 0 : pin.Length + 1)];

              data[0] = (byte)(bdAddr & 0xFF);
              data[1] = (byte)((bdAddr & 0xFF00) >> 8);
              data[2] = (byte)((bdAddr & 0xFF0000) >> 16);
              data[3] = (byte)((bdAddr & 0xFF000000) >> 24);
              data[4] = (byte)((bdAddr & 0xFF00000000) >> 32);
              data[5] = (byte)((bdAddr & 0xFF0000000000) >> 40);
              if (!String.IsNullOrEmpty(pin))
              {
            data[6] = (byte)pin.Length;
            for (int i = 0; i < pin.Length; i++)
              data[7 + i] = (byte)pin[i];

            opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.SendPINCodeRequestReply);
              }
              else
            opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.SendPINCodeRequestNegativeReply);

              _SendHCICommand(opcode, data, true);
        }
Esempio n. 12
0
        public string GetRemoteName(InquiryResult device)
        {
            var data = new byte[10];
              var ret = String.Empty;

              data[0] = (byte)(device.BDAddr & 0xFF);
              data[1] = (byte)((device.BDAddr & 0xFF00) >> 8);
              data[2] = (byte)((device.BDAddr & 0xFF0000) >> 16);
              data[3] = (byte)((device.BDAddr & 0xFF000000) >> 24);
              data[4] = (byte)((device.BDAddr & 0xFF00000000) >> 32);
              data[5] = (byte)((device.BDAddr & 0xFF0000000000) >> 40);
              data[6] = device.PageScanRepetitionMode;
              data[8] = (byte)(device.ClockOffset & 0xFF);
              data[9] = (byte)((byte)((device.ClockOffset & 0xFF00) >> 8) | (byte)0x80);

              var opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.RemoteNameRequest);
              _SendHCICommand(opcode, data);

              if (_commandData.ContainsKey(opcode))
              {
            ret = _commandData[opcode] as string;
            _commandData.Remove(opcode);
              }

              return ret;
        }
Esempio n. 13
0
        public List<InquiryResult> DoInquiryScan(int timeoutSeconds)
        {
            const int iac = (int)AssignedNumbers.GeneralUnlimitedIAC;
              var data = new byte[5];
              int timeout = Convert.ToInt32(Math.Round(timeoutSeconds / 1.28));
              if (timeout <= 0 || timeout > 0x30) throw new ArgumentException("Invalid timeout");
              var ret = new List<InquiryResult>();

              data[0] = (byte)(iac & 0xFF);
              data[1] = (byte)((iac & 0xFF00) >> 8);
              data[2] = (byte)((iac & 0xFF0000) >> 16);
              data[3] = Convert.ToByte(timeout);

              var opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.Inquiry);
              _SendHCICommand(opcode, data);

              if (_commandData.ContainsKey(opcode))
              {
            ret = _commandData[opcode] as List<InquiryResult>;
            _commandData.Remove(opcode);
              }

              return ret;
        }
Esempio n. 14
0
        public void Connect(ulong bdAddr, byte pageScanRepetitionMode, ushort clockOffset)
        {
            var data = new byte[13];

              data[0] = (byte)(bdAddr & 0xFF);
              data[1] = (byte)((bdAddr & 0xFF00) >> 8);
              data[2] = (byte)((bdAddr & 0xFF0000) >> 16);
              data[3] = (byte)((bdAddr & 0xFF000000) >> 24);
              data[4] = (byte)((bdAddr & 0xFF00000000) >> 32);
              data[5] = (byte)((bdAddr & 0xFF0000000000) >> 40);
              data[6] = (byte)0x18;
              data[7] = (byte)0x00;
              data[8] = pageScanRepetitionMode;
              data[9] = 0x00;
              data[10] = (byte)(clockOffset & 0xFF);
              data[11] = (byte)(((clockOffset >> 8) & 0xFF) | 0x80);
              data[12] = 0x00;

              var opcode = new Opcode(OpcodeGroupField.LinkControl, OpcodeCommandField.CreateConnection);
              _SendHCICommand(opcode, data, true);
        }