mirror of
https://github.com/Alkaid-Benetnash/EmuBTHID.git
synced 2026-01-21 07:50:28 +01:00
86 lines
3 KiB
Python
86 lines
3 KiB
Python
import dbus
|
|
import dbus.service
|
|
import os
|
|
import socket
|
|
|
|
|
|
class BluetoothHIDProfile(dbus.service.Object):
|
|
def __init__(self, bus, path):
|
|
super(BluetoothHIDProfile, self).__init__(bus, path)
|
|
self.fd = -1
|
|
|
|
@dbus.service.method("org.bluez.Profile1", in_signature="", out_signature="")
|
|
def Release(self):
|
|
raise NotImplementedError("Release")
|
|
|
|
@dbus.service.method("org.bluez.Profile1", in_signature="", out_signature="")
|
|
def Cancel(self):
|
|
raise NotImplementedError("Cancel")
|
|
|
|
@dbus.service.method("org.bluez.Profile1", in_signature="oha{sv}", out_signature="")
|
|
def NewConnection(self, path, fd, properties):
|
|
self.fd = fd.take()
|
|
print("New Connection from (%s, %d)" % (path, self.fd))
|
|
for k, v in properties.items():
|
|
if k == "Version" or k == "Features":
|
|
print(" %s = 0x%04x " % (k, v))
|
|
else:
|
|
print(" %s = %s" % (k, v))
|
|
|
|
@dbus.service.method("org.bluez.Profile1",
|
|
in_signature="o", out_signature="")
|
|
def RequestDisconnection(self, path):
|
|
print("RequestDisconnection(%s)" % (path))
|
|
|
|
if (self.fd > 0):
|
|
os.close(self.fd)
|
|
self.fd = -1
|
|
|
|
|
|
def error_handler(e):
|
|
raise RuntimeError(str(e))
|
|
|
|
|
|
class BluetoothHIDService(object):
|
|
PROFILE_PATH = "/org/bluez/bthid_profile"
|
|
|
|
HOST = 0
|
|
PORT = 1
|
|
|
|
def __init__(self, service_record, MAC):
|
|
self.P_CTRL = 0x0011
|
|
self.P_INTR = 0x0013
|
|
self.SELFMAC = MAC
|
|
bus = dbus.SystemBus()
|
|
bluez_obj = bus.get_object("org.bluez", "/org/bluez")
|
|
manager = dbus.Interface(bluez_obj, "org.bluez.ProfileManager1")
|
|
|
|
BluetoothHIDProfile(bus, self.PROFILE_PATH)
|
|
opts = {
|
|
"ServiceRecord": service_record,
|
|
"Name": "BTKeyboardProfile",
|
|
"RequireAuthentication": False,
|
|
"RequireAuthorization": False,
|
|
"Service": "MY BTKBD",
|
|
"Role": "server"
|
|
}
|
|
|
|
sock_control = socket.socket(socket.AF_BLUETOOTH, socket.SOCK_SEQPACKET, socket.BTPROTO_L2CAP)
|
|
sock_control.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
|
|
sock_inter = socket.socket(socket.AF_BLUETOOTH, socket.SOCK_SEQPACKET, socket.BTPROTO_L2CAP)
|
|
sock_inter.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
|
|
sock_control.bind((self.SELFMAC, self.P_CTRL))
|
|
sock_inter.bind((self.SELFMAC, self.P_INTR))
|
|
manager.RegisterProfile(self.PROFILE_PATH, "00001124-0000-1000-8000-00805f9b34fb", opts)
|
|
print("Registered")
|
|
sock_control.listen(1)
|
|
sock_inter.listen(1)
|
|
print(f"waiting for connection at controller {MAC}, please double check with the MAC in bluetoothctl")
|
|
self.ccontrol, cinfo = sock_control.accept()
|
|
print("Control channel connected to " + cinfo[self.HOST])
|
|
self.cinter, cinfo = sock_inter.accept()
|
|
print("Interrupt channel connected to " + cinfo[self.HOST])
|
|
|
|
def send(self, bytes_buf):
|
|
self.cinter.send(bytes_buf)
|