Orange Pi5 kernel

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