|
| 1 | +// SPDX-License-Identifier: GPL-2.0 |
| 2 | +/* |
| 3 | + * UAC3 Power Domain state management functions |
| 4 | + */ |
| 5 | + |
| 6 | +#include <linux/slab.h> |
| 7 | +#include <linux/usb.h> |
| 8 | +#include <linux/usb/audio.h> |
| 9 | +#include <linux/usb/audio-v2.h> |
| 10 | +#include <linux/usb/audio-v3.h> |
| 11 | + |
| 12 | +#include "usbaudio.h" |
| 13 | +#include "helper.h" |
| 14 | +#include "power.h" |
| 15 | + |
| 16 | +struct snd_usb_power_domain * |
| 17 | +snd_usb_find_power_domain(struct usb_host_interface *ctrl_iface, |
| 18 | + unsigned char id) |
| 19 | +{ |
| 20 | + struct snd_usb_power_domain *pd; |
| 21 | + void *p; |
| 22 | + |
| 23 | + pd = kzalloc(sizeof(*pd), GFP_KERNEL); |
| 24 | + if (!pd) |
| 25 | + return NULL; |
| 26 | + |
| 27 | + p = NULL; |
| 28 | + while ((p = snd_usb_find_csint_desc(ctrl_iface->extra, |
| 29 | + ctrl_iface->extralen, |
| 30 | + p, UAC3_POWER_DOMAIN)) != NULL) { |
| 31 | + struct uac3_power_domain_descriptor *pd_desc = p; |
| 32 | + int i; |
| 33 | + |
| 34 | + for (i = 0; i < pd_desc->bNrEntities; i++) { |
| 35 | + if (pd_desc->baEntityID[i] == id) { |
| 36 | + pd->pd_id = pd_desc->bPowerDomainID; |
| 37 | + pd->pd_d1d0_rec = |
| 38 | + le16_to_cpu(pd_desc->waRecoveryTime1); |
| 39 | + pd->pd_d2d0_rec = |
| 40 | + le16_to_cpu(pd_desc->waRecoveryTime2); |
| 41 | + return pd; |
| 42 | + } |
| 43 | + } |
| 44 | + } |
| 45 | + |
| 46 | + kfree(pd); |
| 47 | + return NULL; |
| 48 | +} |
| 49 | + |
| 50 | +int snd_usb_power_domain_set(struct snd_usb_audio *chip, |
| 51 | + struct snd_usb_power_domain *pd, |
| 52 | + unsigned char state) |
| 53 | +{ |
| 54 | + struct usb_device *dev = chip->dev; |
| 55 | + unsigned char current_state; |
| 56 | + int err, idx; |
| 57 | + |
| 58 | + idx = snd_usb_ctrl_intf(chip) | (pd->pd_id << 8); |
| 59 | + |
| 60 | + err = snd_usb_ctl_msg(chip->dev, usb_rcvctrlpipe(chip->dev, 0), |
| 61 | + UAC2_CS_CUR, |
| 62 | + USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN, |
| 63 | + UAC3_AC_POWER_DOMAIN_CONTROL << 8, idx, |
| 64 | + ¤t_state, sizeof(current_state)); |
| 65 | + if (err < 0) { |
| 66 | + dev_err(&dev->dev, "Can't get UAC3 power state for id %d\n", |
| 67 | + pd->pd_id); |
| 68 | + return err; |
| 69 | + } |
| 70 | + |
| 71 | + if (current_state == state) { |
| 72 | + dev_dbg(&dev->dev, "UAC3 power domain id %d already in state %d\n", |
| 73 | + pd->pd_id, state); |
| 74 | + return 0; |
| 75 | + } |
| 76 | + |
| 77 | + err = snd_usb_ctl_msg(chip->dev, usb_sndctrlpipe(chip->dev, 0), UAC2_CS_CUR, |
| 78 | + USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT, |
| 79 | + UAC3_AC_POWER_DOMAIN_CONTROL << 8, idx, |
| 80 | + &state, sizeof(state)); |
| 81 | + if (err < 0) { |
| 82 | + dev_err(&dev->dev, "Can't set UAC3 power state to %d for id %d\n", |
| 83 | + state, pd->pd_id); |
| 84 | + return err; |
| 85 | + } |
| 86 | + |
| 87 | + if (state == UAC3_PD_STATE_D0) { |
| 88 | + switch (current_state) { |
| 89 | + case UAC3_PD_STATE_D2: |
| 90 | + udelay(pd->pd_d2d0_rec * 50); |
| 91 | + break; |
| 92 | + case UAC3_PD_STATE_D1: |
| 93 | + udelay(pd->pd_d1d0_rec * 50); |
| 94 | + break; |
| 95 | + default: |
| 96 | + return -EINVAL; |
| 97 | + } |
| 98 | + } |
| 99 | + |
| 100 | + dev_dbg(&dev->dev, "UAC3 power domain id %d change to state %d\n", |
| 101 | + pd->pd_id, state); |
| 102 | + |
| 103 | + return 0; |
| 104 | +} |
0 commit comments