162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * media.c - Media Controller specific ALSA driver code
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (c) 2019 Shuah Khan <shuah@kernel.org>
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci */
862306a36Sopenharmony_ci
962306a36Sopenharmony_ci/*
1062306a36Sopenharmony_ci * This file adds Media Controller support to the ALSA driver
1162306a36Sopenharmony_ci * to use the Media Controller API to share the tuner with DVB
1262306a36Sopenharmony_ci * and V4L2 drivers that control the media device.
1362306a36Sopenharmony_ci *
1462306a36Sopenharmony_ci * The media device is created based on the existing quirks framework.
1562306a36Sopenharmony_ci * Using this approach, the media controller API usage can be added for
1662306a36Sopenharmony_ci * a specific device.
1762306a36Sopenharmony_ci */
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci#include <linux/init.h>
2062306a36Sopenharmony_ci#include <linux/list.h>
2162306a36Sopenharmony_ci#include <linux/mutex.h>
2262306a36Sopenharmony_ci#include <linux/slab.h>
2362306a36Sopenharmony_ci#include <linux/usb.h>
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci#include <sound/pcm.h>
2662306a36Sopenharmony_ci#include <sound/core.h>
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci#include "usbaudio.h"
2962306a36Sopenharmony_ci#include "card.h"
3062306a36Sopenharmony_ci#include "mixer.h"
3162306a36Sopenharmony_ci#include "media.h"
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_ciint snd_media_stream_init(struct snd_usb_substream *subs, struct snd_pcm *pcm,
3462306a36Sopenharmony_ci			  int stream)
3562306a36Sopenharmony_ci{
3662306a36Sopenharmony_ci	struct media_device *mdev;
3762306a36Sopenharmony_ci	struct media_ctl *mctl;
3862306a36Sopenharmony_ci	struct device *pcm_dev = pcm->streams[stream].dev;
3962306a36Sopenharmony_ci	u32 intf_type;
4062306a36Sopenharmony_ci	int ret = 0;
4162306a36Sopenharmony_ci	u16 mixer_pad;
4262306a36Sopenharmony_ci	struct media_entity *entity;
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci	mdev = subs->stream->chip->media_dev;
4562306a36Sopenharmony_ci	if (!mdev)
4662306a36Sopenharmony_ci		return 0;
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci	if (subs->media_ctl)
4962306a36Sopenharmony_ci		return 0;
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci	/* allocate media_ctl */
5262306a36Sopenharmony_ci	mctl = kzalloc(sizeof(*mctl), GFP_KERNEL);
5362306a36Sopenharmony_ci	if (!mctl)
5462306a36Sopenharmony_ci		return -ENOMEM;
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci	mctl->media_dev = mdev;
5762306a36Sopenharmony_ci	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
5862306a36Sopenharmony_ci		intf_type = MEDIA_INTF_T_ALSA_PCM_PLAYBACK;
5962306a36Sopenharmony_ci		mctl->media_entity.function = MEDIA_ENT_F_AUDIO_PLAYBACK;
6062306a36Sopenharmony_ci		mctl->media_pad.flags = MEDIA_PAD_FL_SOURCE;
6162306a36Sopenharmony_ci		mixer_pad = 1;
6262306a36Sopenharmony_ci	} else {
6362306a36Sopenharmony_ci		intf_type = MEDIA_INTF_T_ALSA_PCM_CAPTURE;
6462306a36Sopenharmony_ci		mctl->media_entity.function = MEDIA_ENT_F_AUDIO_CAPTURE;
6562306a36Sopenharmony_ci		mctl->media_pad.flags = MEDIA_PAD_FL_SINK;
6662306a36Sopenharmony_ci		mixer_pad = 2;
6762306a36Sopenharmony_ci	}
6862306a36Sopenharmony_ci	mctl->media_entity.name = pcm->name;
6962306a36Sopenharmony_ci	media_entity_pads_init(&mctl->media_entity, 1, &mctl->media_pad);
7062306a36Sopenharmony_ci	ret =  media_device_register_entity(mctl->media_dev,
7162306a36Sopenharmony_ci					    &mctl->media_entity);
7262306a36Sopenharmony_ci	if (ret)
7362306a36Sopenharmony_ci		goto free_mctl;
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_ci	mctl->intf_devnode = media_devnode_create(mdev, intf_type, 0,
7662306a36Sopenharmony_ci						  MAJOR(pcm_dev->devt),
7762306a36Sopenharmony_ci						  MINOR(pcm_dev->devt));
7862306a36Sopenharmony_ci	if (!mctl->intf_devnode) {
7962306a36Sopenharmony_ci		ret = -ENOMEM;
8062306a36Sopenharmony_ci		goto unregister_entity;
8162306a36Sopenharmony_ci	}
8262306a36Sopenharmony_ci	mctl->intf_link = media_create_intf_link(&mctl->media_entity,
8362306a36Sopenharmony_ci						 &mctl->intf_devnode->intf,
8462306a36Sopenharmony_ci						 MEDIA_LNK_FL_ENABLED);
8562306a36Sopenharmony_ci	if (!mctl->intf_link) {
8662306a36Sopenharmony_ci		ret = -ENOMEM;
8762306a36Sopenharmony_ci		goto devnode_remove;
8862306a36Sopenharmony_ci	}
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	/* create link between mixer and audio */
9162306a36Sopenharmony_ci	media_device_for_each_entity(entity, mdev) {
9262306a36Sopenharmony_ci		switch (entity->function) {
9362306a36Sopenharmony_ci		case MEDIA_ENT_F_AUDIO_MIXER:
9462306a36Sopenharmony_ci			ret = media_create_pad_link(entity, mixer_pad,
9562306a36Sopenharmony_ci						    &mctl->media_entity, 0,
9662306a36Sopenharmony_ci						    MEDIA_LNK_FL_ENABLED);
9762306a36Sopenharmony_ci			if (ret)
9862306a36Sopenharmony_ci				goto remove_intf_link;
9962306a36Sopenharmony_ci			break;
10062306a36Sopenharmony_ci		}
10162306a36Sopenharmony_ci	}
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_ci	subs->media_ctl = mctl;
10462306a36Sopenharmony_ci	return 0;
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ciremove_intf_link:
10762306a36Sopenharmony_ci	media_remove_intf_link(mctl->intf_link);
10862306a36Sopenharmony_cidevnode_remove:
10962306a36Sopenharmony_ci	media_devnode_remove(mctl->intf_devnode);
11062306a36Sopenharmony_ciunregister_entity:
11162306a36Sopenharmony_ci	media_device_unregister_entity(&mctl->media_entity);
11262306a36Sopenharmony_cifree_mctl:
11362306a36Sopenharmony_ci	kfree(mctl);
11462306a36Sopenharmony_ci	return ret;
11562306a36Sopenharmony_ci}
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_civoid snd_media_stream_delete(struct snd_usb_substream *subs)
11862306a36Sopenharmony_ci{
11962306a36Sopenharmony_ci	struct media_ctl *mctl = subs->media_ctl;
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	if (mctl) {
12262306a36Sopenharmony_ci		struct media_device *mdev;
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci		mdev = mctl->media_dev;
12562306a36Sopenharmony_ci		if (mdev && media_devnode_is_registered(mdev->devnode)) {
12662306a36Sopenharmony_ci			media_devnode_remove(mctl->intf_devnode);
12762306a36Sopenharmony_ci			media_device_unregister_entity(&mctl->media_entity);
12862306a36Sopenharmony_ci			media_entity_cleanup(&mctl->media_entity);
12962306a36Sopenharmony_ci		}
13062306a36Sopenharmony_ci		kfree(mctl);
13162306a36Sopenharmony_ci		subs->media_ctl = NULL;
13262306a36Sopenharmony_ci	}
13362306a36Sopenharmony_ci}
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ciint snd_media_start_pipeline(struct snd_usb_substream *subs)
13662306a36Sopenharmony_ci{
13762306a36Sopenharmony_ci	struct media_ctl *mctl = subs->media_ctl;
13862306a36Sopenharmony_ci	int ret = 0;
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	if (!mctl)
14162306a36Sopenharmony_ci		return 0;
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	mutex_lock(&mctl->media_dev->graph_mutex);
14462306a36Sopenharmony_ci	if (mctl->media_dev->enable_source)
14562306a36Sopenharmony_ci		ret = mctl->media_dev->enable_source(&mctl->media_entity,
14662306a36Sopenharmony_ci						     &mctl->media_pipe);
14762306a36Sopenharmony_ci	mutex_unlock(&mctl->media_dev->graph_mutex);
14862306a36Sopenharmony_ci	return ret;
14962306a36Sopenharmony_ci}
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_civoid snd_media_stop_pipeline(struct snd_usb_substream *subs)
15262306a36Sopenharmony_ci{
15362306a36Sopenharmony_ci	struct media_ctl *mctl = subs->media_ctl;
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_ci	if (!mctl)
15662306a36Sopenharmony_ci		return;
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	mutex_lock(&mctl->media_dev->graph_mutex);
15962306a36Sopenharmony_ci	if (mctl->media_dev->disable_source)
16062306a36Sopenharmony_ci		mctl->media_dev->disable_source(&mctl->media_entity);
16162306a36Sopenharmony_ci	mutex_unlock(&mctl->media_dev->graph_mutex);
16262306a36Sopenharmony_ci}
16362306a36Sopenharmony_ci
16462306a36Sopenharmony_cistatic int snd_media_mixer_init(struct snd_usb_audio *chip)
16562306a36Sopenharmony_ci{
16662306a36Sopenharmony_ci	struct device *ctl_dev = chip->card->ctl_dev;
16762306a36Sopenharmony_ci	struct media_intf_devnode *ctl_intf;
16862306a36Sopenharmony_ci	struct usb_mixer_interface *mixer;
16962306a36Sopenharmony_ci	struct media_device *mdev = chip->media_dev;
17062306a36Sopenharmony_ci	struct media_mixer_ctl *mctl;
17162306a36Sopenharmony_ci	u32 intf_type = MEDIA_INTF_T_ALSA_CONTROL;
17262306a36Sopenharmony_ci	int ret;
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci	if (!mdev)
17562306a36Sopenharmony_ci		return -ENODEV;
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	ctl_intf = chip->ctl_intf_media_devnode;
17862306a36Sopenharmony_ci	if (!ctl_intf) {
17962306a36Sopenharmony_ci		ctl_intf = media_devnode_create(mdev, intf_type, 0,
18062306a36Sopenharmony_ci						MAJOR(ctl_dev->devt),
18162306a36Sopenharmony_ci						MINOR(ctl_dev->devt));
18262306a36Sopenharmony_ci		if (!ctl_intf)
18362306a36Sopenharmony_ci			return -ENOMEM;
18462306a36Sopenharmony_ci		chip->ctl_intf_media_devnode = ctl_intf;
18562306a36Sopenharmony_ci	}
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_ci	list_for_each_entry(mixer, &chip->mixer_list, list) {
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_ci		if (mixer->media_mixer_ctl)
19062306a36Sopenharmony_ci			continue;
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci		/* allocate media_mixer_ctl */
19362306a36Sopenharmony_ci		mctl = kzalloc(sizeof(*mctl), GFP_KERNEL);
19462306a36Sopenharmony_ci		if (!mctl)
19562306a36Sopenharmony_ci			return -ENOMEM;
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci		mctl->media_dev = mdev;
19862306a36Sopenharmony_ci		mctl->media_entity.function = MEDIA_ENT_F_AUDIO_MIXER;
19962306a36Sopenharmony_ci		mctl->media_entity.name = chip->card->mixername;
20062306a36Sopenharmony_ci		mctl->media_pad[0].flags = MEDIA_PAD_FL_SINK;
20162306a36Sopenharmony_ci		mctl->media_pad[1].flags = MEDIA_PAD_FL_SOURCE;
20262306a36Sopenharmony_ci		mctl->media_pad[2].flags = MEDIA_PAD_FL_SOURCE;
20362306a36Sopenharmony_ci		media_entity_pads_init(&mctl->media_entity, MEDIA_MIXER_PAD_MAX,
20462306a36Sopenharmony_ci				  mctl->media_pad);
20562306a36Sopenharmony_ci		ret =  media_device_register_entity(mctl->media_dev,
20662306a36Sopenharmony_ci						    &mctl->media_entity);
20762306a36Sopenharmony_ci		if (ret) {
20862306a36Sopenharmony_ci			kfree(mctl);
20962306a36Sopenharmony_ci			return ret;
21062306a36Sopenharmony_ci		}
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci		mctl->intf_link = media_create_intf_link(&mctl->media_entity,
21362306a36Sopenharmony_ci							 &ctl_intf->intf,
21462306a36Sopenharmony_ci							 MEDIA_LNK_FL_ENABLED);
21562306a36Sopenharmony_ci		if (!mctl->intf_link) {
21662306a36Sopenharmony_ci			media_device_unregister_entity(&mctl->media_entity);
21762306a36Sopenharmony_ci			media_entity_cleanup(&mctl->media_entity);
21862306a36Sopenharmony_ci			kfree(mctl);
21962306a36Sopenharmony_ci			return -ENOMEM;
22062306a36Sopenharmony_ci		}
22162306a36Sopenharmony_ci		mctl->intf_devnode = ctl_intf;
22262306a36Sopenharmony_ci		mixer->media_mixer_ctl = mctl;
22362306a36Sopenharmony_ci	}
22462306a36Sopenharmony_ci	return 0;
22562306a36Sopenharmony_ci}
22662306a36Sopenharmony_ci
22762306a36Sopenharmony_cistatic void snd_media_mixer_delete(struct snd_usb_audio *chip)
22862306a36Sopenharmony_ci{
22962306a36Sopenharmony_ci	struct usb_mixer_interface *mixer;
23062306a36Sopenharmony_ci	struct media_device *mdev = chip->media_dev;
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	if (!mdev)
23362306a36Sopenharmony_ci		return;
23462306a36Sopenharmony_ci
23562306a36Sopenharmony_ci	list_for_each_entry(mixer, &chip->mixer_list, list) {
23662306a36Sopenharmony_ci		struct media_mixer_ctl *mctl;
23762306a36Sopenharmony_ci
23862306a36Sopenharmony_ci		mctl = mixer->media_mixer_ctl;
23962306a36Sopenharmony_ci		if (!mixer->media_mixer_ctl)
24062306a36Sopenharmony_ci			continue;
24162306a36Sopenharmony_ci
24262306a36Sopenharmony_ci		if (media_devnode_is_registered(mdev->devnode)) {
24362306a36Sopenharmony_ci			media_device_unregister_entity(&mctl->media_entity);
24462306a36Sopenharmony_ci			media_entity_cleanup(&mctl->media_entity);
24562306a36Sopenharmony_ci		}
24662306a36Sopenharmony_ci		kfree(mctl);
24762306a36Sopenharmony_ci		mixer->media_mixer_ctl = NULL;
24862306a36Sopenharmony_ci	}
24962306a36Sopenharmony_ci	if (media_devnode_is_registered(mdev->devnode))
25062306a36Sopenharmony_ci		media_devnode_remove(chip->ctl_intf_media_devnode);
25162306a36Sopenharmony_ci	chip->ctl_intf_media_devnode = NULL;
25262306a36Sopenharmony_ci}
25362306a36Sopenharmony_ci
25462306a36Sopenharmony_ciint snd_media_device_create(struct snd_usb_audio *chip,
25562306a36Sopenharmony_ci			struct usb_interface *iface)
25662306a36Sopenharmony_ci{
25762306a36Sopenharmony_ci	struct media_device *mdev;
25862306a36Sopenharmony_ci	struct usb_device *usbdev = interface_to_usbdev(iface);
25962306a36Sopenharmony_ci	int ret = 0;
26062306a36Sopenharmony_ci
26162306a36Sopenharmony_ci	/* usb-audio driver is probed for each usb interface, and
26262306a36Sopenharmony_ci	 * there are multiple interfaces per device. Avoid calling
26362306a36Sopenharmony_ci	 * media_device_usb_allocate() each time usb_audio_probe()
26462306a36Sopenharmony_ci	 * is called. Do it only once.
26562306a36Sopenharmony_ci	 */
26662306a36Sopenharmony_ci	if (chip->media_dev) {
26762306a36Sopenharmony_ci		mdev = chip->media_dev;
26862306a36Sopenharmony_ci		goto snd_mixer_init;
26962306a36Sopenharmony_ci	}
27062306a36Sopenharmony_ci
27162306a36Sopenharmony_ci	mdev = media_device_usb_allocate(usbdev, KBUILD_MODNAME, THIS_MODULE);
27262306a36Sopenharmony_ci	if (IS_ERR(mdev))
27362306a36Sopenharmony_ci		return -ENOMEM;
27462306a36Sopenharmony_ci
27562306a36Sopenharmony_ci	/* save media device - avoid lookups */
27662306a36Sopenharmony_ci	chip->media_dev = mdev;
27762306a36Sopenharmony_ci
27862306a36Sopenharmony_cisnd_mixer_init:
27962306a36Sopenharmony_ci	/* Create media entities for mixer and control dev */
28062306a36Sopenharmony_ci	ret = snd_media_mixer_init(chip);
28162306a36Sopenharmony_ci	/* media_device might be registered, print error and continue */
28262306a36Sopenharmony_ci	if (ret)
28362306a36Sopenharmony_ci		dev_err(&usbdev->dev,
28462306a36Sopenharmony_ci			"Couldn't create media mixer entities. Error: %d\n",
28562306a36Sopenharmony_ci			ret);
28662306a36Sopenharmony_ci
28762306a36Sopenharmony_ci	if (!media_devnode_is_registered(mdev->devnode)) {
28862306a36Sopenharmony_ci		/* don't register if snd_media_mixer_init() failed */
28962306a36Sopenharmony_ci		if (ret)
29062306a36Sopenharmony_ci			goto create_fail;
29162306a36Sopenharmony_ci
29262306a36Sopenharmony_ci		/* register media_device */
29362306a36Sopenharmony_ci		ret = media_device_register(mdev);
29462306a36Sopenharmony_cicreate_fail:
29562306a36Sopenharmony_ci		if (ret) {
29662306a36Sopenharmony_ci			snd_media_mixer_delete(chip);
29762306a36Sopenharmony_ci			media_device_delete(mdev, KBUILD_MODNAME, THIS_MODULE);
29862306a36Sopenharmony_ci			/* clear saved media_dev */
29962306a36Sopenharmony_ci			chip->media_dev = NULL;
30062306a36Sopenharmony_ci			dev_err(&usbdev->dev,
30162306a36Sopenharmony_ci				"Couldn't register media device. Error: %d\n",
30262306a36Sopenharmony_ci				ret);
30362306a36Sopenharmony_ci			return ret;
30462306a36Sopenharmony_ci		}
30562306a36Sopenharmony_ci	}
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_ci	return ret;
30862306a36Sopenharmony_ci}
30962306a36Sopenharmony_ci
31062306a36Sopenharmony_civoid snd_media_device_delete(struct snd_usb_audio *chip)
31162306a36Sopenharmony_ci{
31262306a36Sopenharmony_ci	struct media_device *mdev = chip->media_dev;
31362306a36Sopenharmony_ci	struct snd_usb_stream *stream;
31462306a36Sopenharmony_ci
31562306a36Sopenharmony_ci	/* release resources */
31662306a36Sopenharmony_ci	list_for_each_entry(stream, &chip->pcm_list, list) {
31762306a36Sopenharmony_ci		snd_media_stream_delete(&stream->substream[0]);
31862306a36Sopenharmony_ci		snd_media_stream_delete(&stream->substream[1]);
31962306a36Sopenharmony_ci	}
32062306a36Sopenharmony_ci
32162306a36Sopenharmony_ci	snd_media_mixer_delete(chip);
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ci	if (mdev) {
32462306a36Sopenharmony_ci		media_device_delete(mdev, KBUILD_MODNAME, THIS_MODULE);
32562306a36Sopenharmony_ci		chip->media_dev = NULL;
32662306a36Sopenharmony_ci	}
32762306a36Sopenharmony_ci}
328