| /* |
| * QEMU USB audio device |
| * |
| * written by: |
| * H. Peter Anvin <hpa@linux.intel.com> |
| * Gerd Hoffmann <kraxel@redhat.com> |
| * |
| * lousely based on usb net device code which is: |
| * |
| * Copyright (c) 2006 Thomas Sailer |
| * Copyright (c) 2008 Andrzej Zaborowski |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a copy |
| * of this software and associated documentation files (the "Software"), to deal |
| * in the Software without restriction, including without limitation the rights |
| * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| * copies of the Software, and to permit persons to whom the Software is |
| * furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice shall be included in |
| * all copies or substantial portions of the Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| * THE SOFTWARE. |
| */ |
| |
| #include "qemu/osdep.h" |
| #include "qemu/module.h" |
| #include "hw/qdev-properties.h" |
| #include "hw/usb.h" |
| #include "migration/vmstate.h" |
| #include "desc.h" |
| #include "audio/audio.h" |
| #include "qom/object.h" |
| |
| static void usb_audio_reinit(USBDevice *dev, unsigned channels); |
| |
| #define USBAUDIO_VENDOR_NUM 0x46f4 /* CRC16() of "QEMU" */ |
| #define USBAUDIO_PRODUCT_NUM 0x0002 |
| |
| #define DEV_CONFIG_VALUE 1 /* The one and only */ |
| |
| #define USBAUDIO_MAX_CHANNELS(s) (s->multi ? 8 : 2) |
| |
| /* Descriptor subtypes for AC interfaces */ |
| #define DST_AC_HEADER 1 |
| #define DST_AC_INPUT_TERMINAL 2 |
| #define DST_AC_OUTPUT_TERMINAL 3 |
| #define DST_AC_FEATURE_UNIT 6 |
| /* Descriptor subtypes for AS interfaces */ |
| #define DST_AS_GENERAL 1 |
| #define DST_AS_FORMAT_TYPE 2 |
| /* Descriptor subtypes for endpoints */ |
| #define DST_EP_GENERAL 1 |
| |
| enum usb_audio_strings { |
| STRING_NULL, |
| STRING_MANUFACTURER, |
| STRING_PRODUCT, |
| STRING_SERIALNUMBER, |
| STRING_CONFIG, |
| STRING_USBAUDIO_CONTROL, |
| STRING_INPUT_TERMINAL, |
| STRING_FEATURE_UNIT, |
| STRING_OUTPUT_TERMINAL, |
| STRING_NULL_STREAM, |
| STRING_REAL_STREAM, |
| }; |
| |
| static const USBDescStrings usb_audio_stringtable = { |
| [STRING_MANUFACTURER] = "QEMU", |
| [STRING_PRODUCT] = "QEMU USB Audio", |
| [STRING_SERIALNUMBER] = "1", |
| [STRING_CONFIG] = "Audio Configuration", |
| [STRING_USBAUDIO_CONTROL] = "Audio Device", |
| [STRING_INPUT_TERMINAL] = "Audio Output Pipe", |
| [STRING_FEATURE_UNIT] = "Audio Output Volume Control", |
| [STRING_OUTPUT_TERMINAL] = "Audio Output Terminal", |
| [STRING_NULL_STREAM] = "Audio Output - Disabled", |
| [STRING_REAL_STREAM] = "Audio Output - 48 kHz Stereo", |
| }; |
| |
| /* |
| * A USB audio device supports an arbitrary number of alternate |
| * interface settings for each interface. Each corresponds to a block |
| * diagram of parameterized blocks. This can thus refer to things like |
| * number of channels, data rates, or in fact completely different |
| * block diagrams. Alternative setting 0 is always the null block diagram, |
| * which is used by a disabled device. |
| */ |
| enum usb_audio_altset { |
| ALTSET_OFF = 0x00, /* No endpoint */ |
| ALTSET_STEREO = 0x01, /* Single endpoint */ |
| ALTSET_51 = 0x02, |
| ALTSET_71 = 0x03, |
| }; |
| |
| static unsigned altset_channels[] = { |
| [ALTSET_STEREO] = 2, |
| [ALTSET_51] = 6, |
| [ALTSET_71] = 8, |
| }; |
| |
| #define U16(x) ((x) & 0xff), (((x) >> 8) & 0xff) |
| #define U24(x) U16(x), (((x) >> 16) & 0xff) |
| #define U32(x) U24(x), (((x) >> 24) & 0xff) |
| |
| /* |
| * A Basic Audio Device uses these specific values |
| */ |
| #define USBAUDIO_PACKET_SIZE_BASE 96 |
| #define USBAUDIO_PACKET_SIZE(channels) (USBAUDIO_PACKET_SIZE_BASE * channels) |
| #define USBAUDIO_SAMPLE_RATE 48000 |
| #define USBAUDIO_PACKET_INTERVAL 1 |
| |
| static const USBDescIface desc_iface[] = { |
| { |
| .bInterfaceNumber = 0, |
| .bNumEndpoints = 0, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_CONTROL, |
| .iInterface = STRING_USBAUDIO_CONTROL, |
| .ndesc = 4, |
| .descs = (USBDescOther[]) { |
| { |
| /* Headphone Class-Specific AC Interface Header Descriptor */ |
| .data = (uint8_t[]) { |
| 0x09, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_HEADER, /* u8 bDescriptorSubtype */ |
| U16(0x0100), /* u16 bcdADC */ |
| U16(0x2b), /* u16 wTotalLength */ |
| 0x01, /* u8 bInCollection */ |
| 0x01, /* u8 baInterfaceNr */ |
| } |
| },{ |
| /* Generic Stereo Input Terminal ID1 Descriptor */ |
| .data = (uint8_t[]) { |
| 0x0c, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_INPUT_TERMINAL, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bTerminalID */ |
| U16(0x0101), /* u16 wTerminalType */ |
| 0x00, /* u8 bAssocTerminal */ |
| 0x02, /* u8 bNrChannels */ |
| U16(0x0003), /* u16 wChannelConfig */ |
| 0x00, /* u8 iChannelNames */ |
| STRING_INPUT_TERMINAL, /* u8 iTerminal */ |
| } |
| },{ |
| /* Generic Stereo Feature Unit ID2 Descriptor */ |
| .data = (uint8_t[]) { |
| 0x0d, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_FEATURE_UNIT, /* u8 bDescriptorSubtype */ |
| 0x02, /* u8 bUnitID */ |
| 0x01, /* u8 bSourceID */ |
| 0x02, /* u8 bControlSize */ |
| U16(0x0001), /* u16 bmaControls(0) */ |
| U16(0x0002), /* u16 bmaControls(1) */ |
| U16(0x0002), /* u16 bmaControls(2) */ |
| STRING_FEATURE_UNIT, /* u8 iFeature */ |
| } |
| },{ |
| /* Headphone Output Terminal ID3 Descriptor */ |
| .data = (uint8_t[]) { |
| 0x09, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_OUTPUT_TERMINAL, /* u8 bDescriptorSubtype */ |
| 0x03, /* u8 bUnitID */ |
| U16(0x0301), /* u16 wTerminalType (SPK) */ |
| 0x00, /* u8 bAssocTerminal */ |
| 0x02, /* u8 bSourceID */ |
| STRING_OUTPUT_TERMINAL, /* u8 iTerminal */ |
| } |
| } |
| }, |
| },{ |
| .bInterfaceNumber = 1, |
| .bAlternateSetting = ALTSET_OFF, |
| .bNumEndpoints = 0, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_STREAMING, |
| .iInterface = STRING_NULL_STREAM, |
| },{ |
| .bInterfaceNumber = 1, |
| .bAlternateSetting = ALTSET_STEREO, |
| .bNumEndpoints = 1, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_STREAMING, |
| .iInterface = STRING_REAL_STREAM, |
| .ndesc = 2, |
| .descs = (USBDescOther[]) { |
| { |
| /* Headphone Class-specific AS General Interface Descriptor */ |
| .data = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bTerminalLink */ |
| 0x00, /* u8 bDelay */ |
| 0x01, 0x00, /* u16 wFormatTag */ |
| } |
| },{ |
| /* Headphone Type I Format Type Descriptor */ |
| .data = (uint8_t[]) { |
| 0x0b, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_FORMAT_TYPE, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bFormatType */ |
| 0x02, /* u8 bNrChannels */ |
| 0x02, /* u8 bSubFrameSize */ |
| 0x10, /* u8 bBitResolution */ |
| 0x01, /* u8 bSamFreqType */ |
| U24(USBAUDIO_SAMPLE_RATE), /* u24 tSamFreq */ |
| } |
| } |
| }, |
| .eps = (USBDescEndpoint[]) { |
| { |
| .bEndpointAddress = USB_DIR_OUT | 0x01, |
| .bmAttributes = 0x0d, |
| .wMaxPacketSize = USBAUDIO_PACKET_SIZE(2), |
| .bInterval = 1, |
| .is_audio = 1, |
| /* Stereo Headphone Class-specific |
| AS Audio Data Endpoint Descriptor */ |
| .extra = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_ENDPOINT, /* u8 bDescriptorType */ |
| DST_EP_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x00, /* u8 bmAttributes */ |
| 0x00, /* u8 bLockDelayUnits */ |
| U16(0x0000), /* u16 wLockDelay */ |
| }, |
| }, |
| } |
| } |
| }; |
| |
| static const USBDescDevice desc_device = { |
| .bcdUSB = 0x0100, |
| .bMaxPacketSize0 = 64, |
| .bNumConfigurations = 1, |
| .confs = (USBDescConfig[]) { |
| { |
| .bNumInterfaces = 2, |
| .bConfigurationValue = DEV_CONFIG_VALUE, |
| .iConfiguration = STRING_CONFIG, |
| .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER, |
| .bMaxPower = 0x32, |
| .nif = ARRAY_SIZE(desc_iface), |
| .ifs = desc_iface, |
| }, |
| }, |
| }; |
| |
| static const USBDesc desc_audio = { |
| .id = { |
| .idVendor = USBAUDIO_VENDOR_NUM, |
| .idProduct = USBAUDIO_PRODUCT_NUM, |
| .bcdDevice = 0, |
| .iManufacturer = STRING_MANUFACTURER, |
| .iProduct = STRING_PRODUCT, |
| .iSerialNumber = STRING_SERIALNUMBER, |
| }, |
| .full = &desc_device, |
| .str = usb_audio_stringtable, |
| }; |
| |
| /* multi channel compatible desc */ |
| |
| static const USBDescIface desc_iface_multi[] = { |
| { |
| .bInterfaceNumber = 0, |
| .bNumEndpoints = 0, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_CONTROL, |
| .iInterface = STRING_USBAUDIO_CONTROL, |
| .ndesc = 4, |
| .descs = (USBDescOther[]) { |
| { |
| /* Headphone Class-Specific AC Interface Header Descriptor */ |
| .data = (uint8_t[]) { |
| 0x09, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_HEADER, /* u8 bDescriptorSubtype */ |
| U16(0x0100), /* u16 bcdADC */ |
| U16(0x37), /* u16 wTotalLength */ |
| 0x01, /* u8 bInCollection */ |
| 0x01, /* u8 baInterfaceNr */ |
| } |
| },{ |
| /* Generic Stereo Input Terminal ID1 Descriptor */ |
| .data = (uint8_t[]) { |
| 0x0c, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_INPUT_TERMINAL, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bTerminalID */ |
| U16(0x0101), /* u16 wTerminalType */ |
| 0x00, /* u8 bAssocTerminal */ |
| 0x08, /* u8 bNrChannels */ |
| U16(0x063f), /* u16 wChannelConfig */ |
| 0x00, /* u8 iChannelNames */ |
| STRING_INPUT_TERMINAL, /* u8 iTerminal */ |
| } |
| },{ |
| /* Generic Stereo Feature Unit ID2 Descriptor */ |
| .data = (uint8_t[]) { |
| 0x19, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_FEATURE_UNIT, /* u8 bDescriptorSubtype */ |
| 0x02, /* u8 bUnitID */ |
| 0x01, /* u8 bSourceID */ |
| 0x02, /* u8 bControlSize */ |
| U16(0x0001), /* u16 bmaControls(0) */ |
| U16(0x0002), /* u16 bmaControls(1) */ |
| U16(0x0002), /* u16 bmaControls(2) */ |
| U16(0x0002), /* u16 bmaControls(3) */ |
| U16(0x0002), /* u16 bmaControls(4) */ |
| U16(0x0002), /* u16 bmaControls(5) */ |
| U16(0x0002), /* u16 bmaControls(6) */ |
| U16(0x0002), /* u16 bmaControls(7) */ |
| U16(0x0002), /* u16 bmaControls(8) */ |
| STRING_FEATURE_UNIT, /* u8 iFeature */ |
| } |
| },{ |
| /* Headphone Output Terminal ID3 Descriptor */ |
| .data = (uint8_t[]) { |
| 0x09, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AC_OUTPUT_TERMINAL, /* u8 bDescriptorSubtype */ |
| 0x03, /* u8 bUnitID */ |
| U16(0x0301), /* u16 wTerminalType (SPK) */ |
| 0x00, /* u8 bAssocTerminal */ |
| 0x02, /* u8 bSourceID */ |
| STRING_OUTPUT_TERMINAL, /* u8 iTerminal */ |
| } |
| } |
| }, |
| },{ |
| .bInterfaceNumber = 1, |
| .bAlternateSetting = ALTSET_OFF, |
| .bNumEndpoints = 0, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_STREAMING, |
| .iInterface = STRING_NULL_STREAM, |
| },{ |
| .bInterfaceNumber = 1, |
| .bAlternateSetting = ALTSET_STEREO, |
| .bNumEndpoints = 1, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_STREAMING, |
| .iInterface = STRING_REAL_STREAM, |
| .ndesc = 2, |
| .descs = (USBDescOther[]) { |
| { |
| /* Headphone Class-specific AS General Interface Descriptor */ |
| .data = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bTerminalLink */ |
| 0x00, /* u8 bDelay */ |
| 0x01, 0x00, /* u16 wFormatTag */ |
| } |
| },{ |
| /* Headphone Type I Format Type Descriptor */ |
| .data = (uint8_t[]) { |
| 0x0b, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_FORMAT_TYPE, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bFormatType */ |
| 0x02, /* u8 bNrChannels */ |
| 0x02, /* u8 bSubFrameSize */ |
| 0x10, /* u8 bBitResolution */ |
| 0x01, /* u8 bSamFreqType */ |
| U24(USBAUDIO_SAMPLE_RATE), /* u24 tSamFreq */ |
| } |
| } |
| }, |
| .eps = (USBDescEndpoint[]) { |
| { |
| .bEndpointAddress = USB_DIR_OUT | 0x01, |
| .bmAttributes = 0x0d, |
| .wMaxPacketSize = USBAUDIO_PACKET_SIZE(2), |
| .bInterval = 1, |
| .is_audio = 1, |
| /* Stereo Headphone Class-specific |
| AS Audio Data Endpoint Descriptor */ |
| .extra = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_ENDPOINT, /* u8 bDescriptorType */ |
| DST_EP_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x00, /* u8 bmAttributes */ |
| 0x00, /* u8 bLockDelayUnits */ |
| U16(0x0000), /* u16 wLockDelay */ |
| }, |
| }, |
| } |
| },{ |
| .bInterfaceNumber = 1, |
| .bAlternateSetting = ALTSET_51, |
| .bNumEndpoints = 1, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_STREAMING, |
| .iInterface = STRING_REAL_STREAM, |
| .ndesc = 2, |
| .descs = (USBDescOther[]) { |
| { |
| /* Headphone Class-specific AS General Interface Descriptor */ |
| .data = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bTerminalLink */ |
| 0x00, /* u8 bDelay */ |
| 0x01, 0x00, /* u16 wFormatTag */ |
| } |
| },{ |
| /* Headphone Type I Format Type Descriptor */ |
| .data = (uint8_t[]) { |
| 0x0b, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_FORMAT_TYPE, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bFormatType */ |
| 0x06, /* u8 bNrChannels */ |
| 0x02, /* u8 bSubFrameSize */ |
| 0x10, /* u8 bBitResolution */ |
| 0x01, /* u8 bSamFreqType */ |
| U24(USBAUDIO_SAMPLE_RATE), /* u24 tSamFreq */ |
| } |
| } |
| }, |
| .eps = (USBDescEndpoint[]) { |
| { |
| .bEndpointAddress = USB_DIR_OUT | 0x01, |
| .bmAttributes = 0x0d, |
| .wMaxPacketSize = USBAUDIO_PACKET_SIZE(6), |
| .bInterval = 1, |
| .is_audio = 1, |
| /* Stereo Headphone Class-specific |
| AS Audio Data Endpoint Descriptor */ |
| .extra = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_ENDPOINT, /* u8 bDescriptorType */ |
| DST_EP_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x00, /* u8 bmAttributes */ |
| 0x00, /* u8 bLockDelayUnits */ |
| U16(0x0000), /* u16 wLockDelay */ |
| }, |
| }, |
| } |
| },{ |
| .bInterfaceNumber = 1, |
| .bAlternateSetting = ALTSET_71, |
| .bNumEndpoints = 1, |
| .bInterfaceClass = USB_CLASS_AUDIO, |
| .bInterfaceSubClass = USB_SUBCLASS_AUDIO_STREAMING, |
| .iInterface = STRING_REAL_STREAM, |
| .ndesc = 2, |
| .descs = (USBDescOther[]) { |
| { |
| /* Headphone Class-specific AS General Interface Descriptor */ |
| .data = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bTerminalLink */ |
| 0x00, /* u8 bDelay */ |
| 0x01, 0x00, /* u16 wFormatTag */ |
| } |
| },{ |
| /* Headphone Type I Format Type Descriptor */ |
| .data = (uint8_t[]) { |
| 0x0b, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| DST_AS_FORMAT_TYPE, /* u8 bDescriptorSubtype */ |
| 0x01, /* u8 bFormatType */ |
| 0x08, /* u8 bNrChannels */ |
| 0x02, /* u8 bSubFrameSize */ |
| 0x10, /* u8 bBitResolution */ |
| 0x01, /* u8 bSamFreqType */ |
| U24(USBAUDIO_SAMPLE_RATE), /* u24 tSamFreq */ |
| } |
| } |
| }, |
| .eps = (USBDescEndpoint[]) { |
| { |
| .bEndpointAddress = USB_DIR_OUT | 0x01, |
| .bmAttributes = 0x0d, |
| .wMaxPacketSize = USBAUDIO_PACKET_SIZE(8), |
| .bInterval = 1, |
| .is_audio = 1, |
| /* Stereo Headphone Class-specific |
| AS Audio Data Endpoint Descriptor */ |
| .extra = (uint8_t[]) { |
| 0x07, /* u8 bLength */ |
| USB_DT_CS_ENDPOINT, /* u8 bDescriptorType */ |
| DST_EP_GENERAL, /* u8 bDescriptorSubtype */ |
| 0x00, /* u8 bmAttributes */ |
| 0x00, /* u8 bLockDelayUnits */ |
| U16(0x0000), /* u16 wLockDelay */ |
| }, |
| }, |
| } |
| } |
| }; |
| |
| static const USBDescDevice desc_device_multi = { |
| .bcdUSB = 0x0100, |
| .bMaxPacketSize0 = 64, |
| .bNumConfigurations = 1, |
| .confs = (USBDescConfig[]) { |
| { |
| .bNumInterfaces = 2, |
| .bConfigurationValue = DEV_CONFIG_VALUE, |
| .iConfiguration = STRING_CONFIG, |
| .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER, |
| .bMaxPower = 0x32, |
| .nif = ARRAY_SIZE(desc_iface_multi), |
| .ifs = desc_iface_multi, |
| } |
| }, |
| }; |
| |
| static const USBDesc desc_audio_multi = { |
| .id = { |
| .idVendor = USBAUDIO_VENDOR_NUM, |
| .idProduct = USBAUDIO_PRODUCT_NUM, |
| .bcdDevice = 0, |
| .iManufacturer = STRING_MANUFACTURER, |
| .iProduct = STRING_PRODUCT, |
| .iSerialNumber = STRING_SERIALNUMBER, |
| }, |
| .full = &desc_device_multi, |
| .str = usb_audio_stringtable, |
| }; |
| |
| /* |
| * Class-specific control requests |
| */ |
| #define CR_SET_CUR 0x01 |
| #define CR_GET_CUR 0x81 |
| #define CR_SET_MIN 0x02 |
| #define CR_GET_MIN 0x82 |
| #define CR_SET_MAX 0x03 |
| #define CR_GET_MAX 0x83 |
| #define CR_SET_RES 0x04 |
| #define CR_GET_RES 0x84 |
| #define CR_SET_MEM 0x05 |
| #define CR_GET_MEM 0x85 |
| #define CR_GET_STAT 0xff |
| |
| /* |
| * Feature Unit Control Selectors |
| */ |
| #define MUTE_CONTROL 0x01 |
| #define VOLUME_CONTROL 0x02 |
| #define BASS_CONTROL 0x03 |
| #define MID_CONTROL 0x04 |
| #define TREBLE_CONTROL 0x05 |
| #define GRAPHIC_EQUALIZER_CONTROL 0x06 |
| #define AUTOMATIC_GAIN_CONTROL 0x07 |
| #define DELAY_CONTROL 0x08 |
| #define BASS_BOOST_CONTROL 0x09 |
| #define LOUDNESS_CONTROL 0x0a |
| |
| /* |
| * buffering |
| */ |
| |
| struct streambuf { |
| uint8_t *data; |
| size_t size; |
| uint64_t prod; |
| uint64_t cons; |
| }; |
| |
| static void streambuf_init(struct streambuf *buf, uint32_t size, |
| uint32_t channels) |
| { |
| g_free(buf->data); |
| buf->size = size - (size % USBAUDIO_PACKET_SIZE(channels)); |
| buf->data = g_malloc(buf->size); |
| buf->prod = 0; |
| buf->cons = 0; |
| } |
| |
| static void streambuf_fini(struct streambuf *buf) |
| { |
| g_free(buf->data); |
| buf->data = NULL; |
| } |
| |
| static int streambuf_put(struct streambuf *buf, USBPacket *p, uint32_t channels) |
| { |
| int64_t free = buf->size - (buf->prod - buf->cons); |
| |
| if (free < USBAUDIO_PACKET_SIZE(channels)) { |
| return 0; |
| } |
| if (p->iov.size != USBAUDIO_PACKET_SIZE(channels)) { |
| return 0; |
| } |
| |
| /* can happen if prod overflows */ |
| assert(buf->prod % USBAUDIO_PACKET_SIZE(channels) == 0); |
| usb_packet_copy(p, buf->data + (buf->prod % buf->size), |
| USBAUDIO_PACKET_SIZE(channels)); |
| buf->prod += USBAUDIO_PACKET_SIZE(channels); |
| return USBAUDIO_PACKET_SIZE(channels); |
| } |
| |
| static uint8_t *streambuf_get(struct streambuf *buf, size_t *len) |
| { |
| int64_t used = buf->prod - buf->cons; |
| uint8_t *data; |
| |
| if (used <= 0) { |
| *len = 0; |
| return NULL; |
| } |
| data = buf->data + (buf->cons % buf->size); |
| *len = MIN(buf->prod - buf->cons, |
| buf->size - (buf->cons % buf->size)); |
| return data; |
| } |
| |
| struct USBAudioState { |
| /* qemu interfaces */ |
| USBDevice dev; |
| QEMUSoundCard card; |
| |
| /* state */ |
| struct { |
| enum usb_audio_altset altset; |
| struct audsettings as; |
| SWVoiceOut *voice; |
| Volume vol; |
| struct streambuf buf; |
| uint32_t channels; |
| } out; |
| |
| /* properties */ |
| uint32_t debug; |
| uint32_t buffer_user, buffer; |
| bool multi; |
| }; |
| |
| #define TYPE_USB_AUDIO "usb-audio" |
| OBJECT_DECLARE_SIMPLE_TYPE(USBAudioState, USB_AUDIO) |
| |
| static void output_callback(void *opaque, int avail) |
| { |
| USBAudioState *s = opaque; |
| uint8_t *data; |
| |
| while (avail) { |
| size_t written, len; |
| |
| data = streambuf_get(&s->out.buf, &len); |
| if (!data) { |
| return; |
| } |
| |
| written = AUD_write(s->out.voice, data, len); |
| avail -= written; |
| s->out.buf.cons += written; |
| |
| if (written < len) { |
| return; |
| } |
| } |
| } |
| |
| static int usb_audio_set_output_altset(USBAudioState *s, int altset) |
| { |
| switch (altset) { |
| case ALTSET_OFF: |
| AUD_set_active_out(s->out.voice, false); |
| break; |
| case ALTSET_STEREO: |
| case ALTSET_51: |
| case ALTSET_71: |
| if (s->out.channels != altset_channels[altset]) { |
| usb_audio_reinit(USB_DEVICE(s), altset_channels[altset]); |
| } |
| streambuf_init(&s->out.buf, s->buffer, s->out.channels); |
| AUD_set_active_out(s->out.voice, true); |
| break; |
| default: |
| return -1; |
| } |
| |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: set interface %d\n", altset); |
| } |
| s->out.altset = altset; |
| return 0; |
| } |
| |
| /* |
| * Note: we arbitrarily map the volume control range onto -inf..+8 dB |
| */ |
| #define ATTRIB_ID(cs, attrib, idif) \ |
| (((cs) << 24) | ((attrib) << 16) | (idif)) |
| |
| static int usb_audio_get_control(USBAudioState *s, uint8_t attrib, |
| uint16_t cscn, uint16_t idif, |
| int length, uint8_t *data) |
| { |
| uint8_t cs = cscn >> 8; |
| uint8_t cn = cscn - 1; /* -1 for the non-present master control */ |
| uint32_t aid = ATTRIB_ID(cs, attrib, idif); |
| int ret = USB_RET_STALL; |
| |
| switch (aid) { |
| case ATTRIB_ID(MUTE_CONTROL, CR_GET_CUR, 0x0200): |
| data[0] = s->out.vol.mute; |
| ret = 1; |
| break; |
| case ATTRIB_ID(VOLUME_CONTROL, CR_GET_CUR, 0x0200): |
| if (cn < USBAUDIO_MAX_CHANNELS(s)) { |
| uint16_t vol = (s->out.vol.vol[cn] * 0x8800 + 127) / 255 + 0x8000; |
| data[0] = vol; |
| data[1] = vol >> 8; |
| ret = 2; |
| } |
| break; |
| case ATTRIB_ID(VOLUME_CONTROL, CR_GET_MIN, 0x0200): |
| if (cn < USBAUDIO_MAX_CHANNELS(s)) { |
| data[0] = 0x01; |
| data[1] = 0x80; |
| ret = 2; |
| } |
| break; |
| case ATTRIB_ID(VOLUME_CONTROL, CR_GET_MAX, 0x0200): |
| if (cn < USBAUDIO_MAX_CHANNELS(s)) { |
| data[0] = 0x00; |
| data[1] = 0x08; |
| ret = 2; |
| } |
| break; |
| case ATTRIB_ID(VOLUME_CONTROL, CR_GET_RES, 0x0200): |
| if (cn < USBAUDIO_MAX_CHANNELS(s)) { |
| data[0] = 0x88; |
| data[1] = 0x00; |
| ret = 2; |
| } |
| break; |
| } |
| |
| return ret; |
| } |
| static int usb_audio_set_control(USBAudioState *s, uint8_t attrib, |
| uint16_t cscn, uint16_t idif, |
| int length, uint8_t *data) |
| { |
| uint8_t cs = cscn >> 8; |
| uint8_t cn = cscn - 1; /* -1 for the non-present master control */ |
| uint32_t aid = ATTRIB_ID(cs, attrib, idif); |
| int ret = USB_RET_STALL; |
| bool set_vol = false; |
| |
| switch (aid) { |
| case ATTRIB_ID(MUTE_CONTROL, CR_SET_CUR, 0x0200): |
| s->out.vol.mute = data[0] & 1; |
| set_vol = true; |
| ret = 0; |
| break; |
| case ATTRIB_ID(VOLUME_CONTROL, CR_SET_CUR, 0x0200): |
| if (cn < USBAUDIO_MAX_CHANNELS(s)) { |
| uint16_t vol = data[0] + (data[1] << 8); |
| |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: cn %d vol %04x\n", cn, |
| (uint16_t)vol); |
| } |
| |
| vol -= 0x8000; |
| vol = (vol * 255 + 0x4400) / 0x8800; |
| if (vol > 255) { |
| vol = 255; |
| } |
| |
| s->out.vol.vol[cn] = vol; |
| set_vol = true; |
| ret = 0; |
| } |
| break; |
| } |
| |
| if (set_vol) { |
| if (s->debug) { |
| int i; |
| fprintf(stderr, "usb-audio: mute %d", s->out.vol.mute); |
| for (i = 0; i < USBAUDIO_MAX_CHANNELS(s); ++i) { |
| fprintf(stderr, ", vol[%d] %3d", i, s->out.vol.vol[i]); |
| } |
| fprintf(stderr, "\n"); |
| } |
| audio_set_volume_out(s->out.voice, &s->out.vol); |
| } |
| |
| return ret; |
| } |
| |
| static void usb_audio_handle_control(USBDevice *dev, USBPacket *p, |
| int request, int value, int index, |
| int length, uint8_t *data) |
| { |
| USBAudioState *s = USB_AUDIO(dev); |
| int ret = 0; |
| |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: control transaction: " |
| "request 0x%04x value 0x%04x index 0x%04x length 0x%04x\n", |
| request, value, index, length); |
| } |
| |
| ret = usb_desc_handle_control(dev, p, request, value, index, length, data); |
| if (ret >= 0) { |
| return; |
| } |
| |
| switch (request) { |
| case ClassInterfaceRequest | CR_GET_CUR: |
| case ClassInterfaceRequest | CR_GET_MIN: |
| case ClassInterfaceRequest | CR_GET_MAX: |
| case ClassInterfaceRequest | CR_GET_RES: |
| ret = usb_audio_get_control(s, request & 0xff, value, index, |
| length, data); |
| if (ret < 0) { |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: fail: get control\n"); |
| } |
| goto fail; |
| } |
| p->actual_length = ret; |
| break; |
| |
| case ClassInterfaceOutRequest | CR_SET_CUR: |
| case ClassInterfaceOutRequest | CR_SET_MIN: |
| case ClassInterfaceOutRequest | CR_SET_MAX: |
| case ClassInterfaceOutRequest | CR_SET_RES: |
| ret = usb_audio_set_control(s, request & 0xff, value, index, |
| length, data); |
| if (ret < 0) { |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: fail: set control\n"); |
| } |
| goto fail; |
| } |
| break; |
| |
| default: |
| fail: |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: failed control transaction: " |
| "request 0x%04x value 0x%04x index 0x%04x length 0x%04x\n", |
| request, value, index, length); |
| } |
| p->status = USB_RET_STALL; |
| break; |
| } |
| } |
| |
| static void usb_audio_set_interface(USBDevice *dev, int iface, |
| int old, int value) |
| { |
| USBAudioState *s = USB_AUDIO(dev); |
| |
| if (iface == 1) { |
| usb_audio_set_output_altset(s, value); |
| } |
| } |
| |
| static void usb_audio_handle_reset(USBDevice *dev) |
| { |
| USBAudioState *s = USB_AUDIO(dev); |
| |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: reset\n"); |
| } |
| usb_audio_set_output_altset(s, ALTSET_OFF); |
| } |
| |
| static void usb_audio_handle_dataout(USBAudioState *s, USBPacket *p) |
| { |
| if (s->out.altset == ALTSET_OFF) { |
| p->status = USB_RET_STALL; |
| return; |
| } |
| |
| streambuf_put(&s->out.buf, p, s->out.channels); |
| if (p->actual_length < p->iov.size && s->debug > 1) { |
| fprintf(stderr, "usb-audio: output overrun (%zd bytes)\n", |
| p->iov.size - p->actual_length); |
| } |
| } |
| |
| static void usb_audio_handle_data(USBDevice *dev, USBPacket *p) |
| { |
| USBAudioState *s = (USBAudioState *) dev; |
| |
| if (p->pid == USB_TOKEN_OUT && p->ep->nr == 1) { |
| usb_audio_handle_dataout(s, p); |
| return; |
| } |
| |
| p->status = USB_RET_STALL; |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: failed data transaction: " |
| "pid 0x%x ep 0x%x len 0x%zx\n", |
| p->pid, p->ep->nr, p->iov.size); |
| } |
| } |
| |
| static void usb_audio_unrealize(USBDevice *dev) |
| { |
| USBAudioState *s = USB_AUDIO(dev); |
| |
| if (s->debug) { |
| fprintf(stderr, "usb-audio: destroy\n"); |
| } |
| |
| usb_audio_set_output_altset(s, ALTSET_OFF); |
| AUD_close_out(&s->card, s->out.voice); |
| AUD_remove_card(&s->card); |
| |
| streambuf_fini(&s->out.buf); |
| } |
| |
| static void usb_audio_realize(USBDevice *dev, Error **errp) |
| { |
| USBAudioState *s = USB_AUDIO(dev); |
| int i; |
| |
| if (!AUD_register_card(TYPE_USB_AUDIO, &s->card, errp)) { |
| return; |
| } |
| |
| dev->usb_desc = s->multi ? &desc_audio_multi : &desc_audio; |
| |
| usb_desc_create_serial(dev); |
| usb_desc_init(dev); |
| s->dev.opaque = s; |
| |
| s->out.altset = ALTSET_OFF; |
| s->out.vol.mute = false; |
| for (i = 0; i < USBAUDIO_MAX_CHANNELS(s); ++i) { |
| s->out.vol.vol[i] = 240; /* 0 dB */ |
| } |
| |
| usb_audio_reinit(dev, 2); |
| } |
| |
| static void usb_audio_reinit(USBDevice *dev, unsigned channels) |
| { |
| USBAudioState *s = USB_AUDIO(dev); |
| |
| s->out.channels = channels; |
| if (!s->buffer_user) { |
| s->buffer = 32 * USBAUDIO_PACKET_SIZE(s->out.channels); |
| } else { |
| s->buffer = s->buffer_user; |
| } |
| |
| s->out.vol.channels = s->out.channels; |
| s->out.as.freq = USBAUDIO_SAMPLE_RATE; |
| s->out.as.nchannels = s->out.channels; |
| s->out.as.fmt = AUDIO_FORMAT_S16; |
| s->out.as.endianness = 0; |
| streambuf_init(&s->out.buf, s->buffer, s->out.channels); |
| |
| s->out.voice = AUD_open_out(&s->card, s->out.voice, TYPE_USB_AUDIO, |
| s, output_callback, &s->out.as); |
| audio_set_volume_out(s->out.voice, &s->out.vol); |
| AUD_set_active_out(s->out.voice, 0); |
| } |
| |
| static const VMStateDescription vmstate_usb_audio = { |
| .name = TYPE_USB_AUDIO, |
| .unmigratable = 1, |
| }; |
| |
| static Property usb_audio_properties[] = { |
| DEFINE_AUDIO_PROPERTIES(USBAudioState, card), |
| DEFINE_PROP_UINT32("debug", USBAudioState, debug, 0), |
| DEFINE_PROP_UINT32("buffer", USBAudioState, buffer_user, 0), |
| DEFINE_PROP_BOOL("multi", USBAudioState, multi, false), |
| DEFINE_PROP_END_OF_LIST(), |
| }; |
| |
| static void usb_audio_class_init(ObjectClass *klass, void *data) |
| { |
| DeviceClass *dc = DEVICE_CLASS(klass); |
| USBDeviceClass *k = USB_DEVICE_CLASS(klass); |
| |
| dc->vmsd = &vmstate_usb_audio; |
| device_class_set_props(dc, usb_audio_properties); |
| set_bit(DEVICE_CATEGORY_SOUND, dc->categories); |
| k->product_desc = "QEMU USB Audio Interface"; |
| k->realize = usb_audio_realize; |
| k->handle_reset = usb_audio_handle_reset; |
| k->handle_control = usb_audio_handle_control; |
| k->handle_data = usb_audio_handle_data; |
| k->unrealize = usb_audio_unrealize; |
| k->set_interface = usb_audio_set_interface; |
| } |
| |
| static const TypeInfo usb_audio_info = { |
| .name = TYPE_USB_AUDIO, |
| .parent = TYPE_USB_DEVICE, |
| .instance_size = sizeof(USBAudioState), |
| .class_init = usb_audio_class_init, |
| }; |
| |
| static void usb_audio_register_types(void) |
| { |
| type_register_static(&usb_audio_info); |
| } |
| |
| type_init(usb_audio_register_types) |
