Mercurial > lcfOS
view python/utils/usb.py @ 393:6ae782a085e0
Added init program
author | Windel Bouwman |
---|---|
date | Sat, 17 May 2014 21:17:40 +0200 |
parents | 534b94b40aa8 |
children |
line wrap: on
line source
from ctypes import Structure, POINTER, CDLL, CFUNCTYPE from ctypes import c_uint16, c_uint8, c_int, c_uint, c_ssize_t, c_void_p from ctypes import byref, create_string_buffer # libusb wrapper: libusb = CDLL('libusb-1.0.so') # helper: def buildfunc(name, argtypes, restype=c_int): f = getattr(libusb, name) f.argtypes = argtypes f.restype = restype globals()[name] = f return f def enum(**enums): reverse = dict((value, key) for key, value in enums.items()) enums['reverse_mapping'] = reverse return type('enum', (), enums) # enums libusb_class_code = enum(PER_INTERFACE=0, AUDIO=1, COMM=2, HID=3, \ PHYSICAL=5, PRINTER=7, PTP=6, MASS_STORAGE=8, HUB=9, \ DATA=10, SMART_CARD=0xb, CONTENT_SECURITY=0xd, VIDEO=0xe, \ PERSONAL_HEALTHCARE=0xf, DIAGNOSTIC_DEVICE=0xdc, WIRELESS=0xe,\ APPLICATION=0xfe, VENDOR_SPEC=0xff) libusb_speed = enum(UNKNOWN=0, LOW=1, FULL=2, HIGH=3, SUPER=4) libusb_error = enum(SUCCES=0, ERROR_IO=-1, ERROR_INVALID_PARAM=-2, \ ERROR_ACCESS=-3, ERROR_NO_DEVICE=-4, ERROR_NOT_FOUND=-5, \ ERROR_BUSY=-6, ERROR_TIMEOUT=-7, ERROR_OVERFLOW=-8, \ ERROR_PIPE=-9, ERROR_INTERRUPTED=-10, ERROR_NO_MEM=-11, \ ERROR_NOT_SUPPORTED=-12, ERROR_OTHER=-99) libusb_transfer_status = enum(\ COMPLETED=0, ERROR=1, TIMED_OUT=2, \ CANCELLED=3, STALL=4, NO_DEVICE=5, OVERFLOW=6) # types c_int_p = POINTER(c_int) class libusb_context(Structure): pass libusb_context_p = POINTER(libusb_context) libusb_context_p_p = POINTER(libusb_context_p) class libusb_device(Structure): pass libusb_device_p = POINTER(libusb_device) libusb_device_p_p = POINTER(libusb_device_p) libusb_device_p_p_p = POINTER(libusb_device_p_p) class libusb_device_handle(Structure): pass libusb_device_handle_p = POINTER(libusb_device_handle) libusb_device_handle_p_p = POINTER(libusb_device_handle_p) class libusb_device_descriptor(Structure): _fields_ = [ ('bLength', c_uint8), ('bDescriptorType', c_uint8), ('bcdUSB', c_uint16), ('bDeviceClass', c_uint8), ('bDeviceSubClass', c_uint8), ('bDeviceProtocol', c_uint8), ('bMaxPacketSize0', c_uint8), ('idVendor', c_uint16), ('idProduct', c_uint16), ('bcdDevice', c_uint16), ('iManufacturer', c_uint8), ('iProduct', c_uint8), ('iSerialNumber', c_uint8), ('iNumConfigurations', c_uint8) ] libusb_device_descriptor_p = POINTER(libusb_device_descriptor) """ class libusb_transfer(Structure): pass libusb_transfer_p = POINTER(libusb_transfer) libusb_transfer_cb_fn = CFUNCTYPE(None, libusb_transfer_p) libusb_transfer._fields_ = [ ('dev_handle', libusb_device_handle_p), ('flags', c_uint8), ('endpoint', c_uchar), ('type', c_uchar), ('timeout', c_uint), ('status', c_int), # enum libusb_transfer_status ('length', c_int), ('actual_length', c_int), ('callback', libusb_transfer_cb_fn), ('userdata', c_void_p), ('buffer', c_void_p), ('num_iso_packets', c_int), ('iso_packet_desc', libusb_iso_packet_descriptor) ] """ # functions buildfunc('libusb_init', [libusb_context_p_p], c_int) buildfunc('libusb_get_device_list', \ [libusb_context_p, libusb_device_p_p_p], c_ssize_t) buildfunc('libusb_free_device_list', [libusb_device_p_p, c_int], None) buildfunc('libusb_get_bus_number', [libusb_device_p], c_uint8) buildfunc('libusb_get_device_address', [libusb_device_p], c_uint8) buildfunc('libusb_get_device_speed', [libusb_device_p]) buildfunc('libusb_unref_device', [libusb_device_p], None) buildfunc('libusb_open', [libusb_device_p, libusb_device_handle_p_p]) buildfunc('libusb_close', [libusb_device_handle_p], None) buildfunc('libusb_get_configuration',[libusb_device_handle_p,POINTER(c_int)]) buildfunc('libusb_set_configuration', [libusb_device_handle_p, c_int]) buildfunc('libusb_claim_interface', [libusb_device_handle_p, c_int]) buildfunc('libusb_get_device_descriptor',\ [libusb_device_p, libusb_device_descriptor_p]) # synchronous functions: buildfunc('libusb_bulk_transfer', [libusb_device_handle_p, c_uint8, \ c_void_p, c_int, c_int_p, c_uint]) # pythonic API: class UsbError(Exception): def __init__(self, msg, errorcode): if errorcode in libusb_error.reverse_mapping: errorcode = libusb_error.reverse_mapping[errorcode] msg = msg + 'Error code: {0}'.format(errorcode) super().__init__(msg) class UsbContext(object): """ A usb context in case of multiple use """ def __init__(self): self.context_p = libusb_context_p() r = libusb_init(byref(self.context_p)) if r != 0: raise UsbError('libusb_init error!', r) def getDeviceList(self): devlist = libusb_device_p_p() count = libusb_get_device_list(self.context_p, byref(devlist)) if count < 0: raise UsbError('Error getting device list', count) l = [UsbDevice(self, device_p.contents) for device_p in devlist[0:count]] libusb_free_device_list(devlist, 0) return l DeviceList = property(getDeviceList) class UsbDevice: """ A detected usb device """ def __init__(self, context, device_p): self.context = context self.dev_p = device_p def __del__(self): libusb_unref_device(self.dev_p) def getBusNumber(self): return libusb_get_bus_number(self.dev_p) BusNumber = property(getBusNumber) def getDeviceAddress(self): return libusb_get_device_address(self.dev_p) DeviceAddress = property(getDeviceAddress) def getSpeed(self): s = libusb_get_device_speed(self.dev_p) if s in libusb_speed.reverse_mapping: s = libusb_speed.reverse_mapping[s] return s Speed = property(getSpeed) def getDescriptor(self): descriptor = libusb_device_descriptor() r = libusb_get_device_descriptor(self.dev_p, byref(descriptor)) if r != 0: raise UsbError('Error getting descriptor', r) return descriptor Descriptor = property(getDescriptor) VendorId = property(lambda self: self.Descriptor.idVendor) ProductId = property(lambda self: self.Descriptor.idProduct) NumConfigurations = property(lambda self: self.Descriptor.bNumConfigurations) def open(self): """ Opens this device and returns a handle """ handle_p = libusb_device_handle_p() r = libusb_open(self.dev_p, byref(handle_p)) if r != 0: raise UsbError('error opening device', r) return UsbDeviceHandle(self, handle_p) def __repr__(self): r2 = 'Usb device: bus {0} address {1} {2:04X}:{3:04X} speed {4}' \ .format( \ self.BusNumber, self.DeviceAddress, self.VendorId, \ self.ProductId, self.Speed) return r2 USB_ENDPOINT_DIR_MASK = 0x80 USB_ENDPOINT_IN = 0x80 USB_ENDPOINT_OUT = 0x0 class UsbDeviceHandle: """ Handle to a detected usb device """ def __init__(self, device, handle_p): self.device = device self.handle_p = handle_p def __del__(self): self.close() def close(self): if self.handle_p: libusb_close(self.handle_p) self.handle_p = None def getConfiguration(self): config = c_int() r = libusb_get_configuration(self.handle_p, byref(config)) if r != 0: raise UsbError('Error getting configuration', r) return config.value def setConfiguration(self, config): r = libusb_set_configuration(self.handle_p, config) if r != 0: raise UsbError('Error setting configuration', r) Configuration = property(getConfiguration, setConfiguration) def claimInterface(self, interface_number): r = libusb_claim_interface(self.handle_p, interface_number) if r != 0: raise UsbError('Error claiming interface', r) def bulkWrite(self, endpoint, data, timeout=0): """ Synchronous bulk write """ assert type(data) is bytes # assure the endpoint indicates the correct: endpoint = (endpoint & (~USB_ENDPOINT_DIR_MASK)) | USB_ENDPOINT_OUT buf = create_string_buffer(data) transferred = c_int() r = libusb_bulk_transfer(self.handle_p, endpoint, buf, len(data), \ byref(transferred), timeout) if r != 0: raise UsbError('Bulk write failed', r) if transferred.value != len(data): raise UsbError('Not all {0} transferred {1}'.format(len(data), \ transferred.value)) def bulkRead(self, endpoint, numbytes, timeout=0): """ Synchronous bulk read """ # assure the endpoint indicates the correct: endpoint = (endpoint & (~USB_ENDPOINT_DIR_MASK)) | USB_ENDPOINT_IN buf = create_string_buffer(numbytes) transferred = c_int() r = libusb_bulk_transfer(self.handle_p, endpoint, buf, numbytes, \ byref(transferred), timeout) if r != 0: raise UsbError('Bulk read failed', r) if transferred.value != numbytes: raise UsbError('Not all {0} transferred {1}'.format(numbytes, \ transferred.value)) data = buf.raw[0:numbytes] return data class UsbTransfer: def __init__(self): libusb_alloc_transfer(0)