[mirror_ubuntu-hirsute-kernel.git] / sound / soc / sof / core.c

// SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
//
// This file is provided under a dual BSD/GPLv2 license.  When using or
// redistributing this file, you may do so under either license.
//
// Copyright(c) 2018 Intel Corporation. All rights reserved.
//
// Author: Liam Girdwood <liam.r.girdwood@linux.intel.com>
//

#include <linux/firmware.h>
#include <linux/module.h>
#include <asm/unaligned.h>
#include <sound/soc.h>
#include <sound/sof.h>
#include "sof-priv.h"
#include "ops.h"

/* SOF defaults if not provided by the platform in ms */
#define TIMEOUT_DEFAULT_IPC_MS  5
#define TIMEOUT_DEFAULT_BOOT_MS 100

/*
 * Generic object lookup APIs.
 */

struct snd_sof_pcm *snd_sof_find_spcm_name(struct snd_sof_dev *sdev,
					   const char *name)
{
	struct snd_sof_pcm *spcm;

	list_for_each_entry(spcm, &sdev->pcm_list, list) {
		/* match with PCM dai name */
		if (strcmp(spcm->pcm.dai_name, name) == 0)
			return spcm;

		/* match with playback caps name if set */
		if (*spcm->pcm.caps[0].name &&
		    !strcmp(spcm->pcm.caps[0].name, name))
			return spcm;

		/* match with capture caps name if set */
		if (*spcm->pcm.caps[1].name &&
		    !strcmp(spcm->pcm.caps[1].name, name))
			return spcm;
	}

	return NULL;
}

struct snd_sof_pcm *snd_sof_find_spcm_comp(struct snd_sof_dev *sdev,
					   unsigned int comp_id,
					   int *direction)
{
	struct snd_sof_pcm *spcm;

	list_for_each_entry(spcm, &sdev->pcm_list, list) {
		if (spcm->stream[SNDRV_PCM_STREAM_PLAYBACK].comp_id == comp_id) {
			*direction = SNDRV_PCM_STREAM_PLAYBACK;
			return spcm;
		}
		if (spcm->stream[SNDRV_PCM_STREAM_CAPTURE].comp_id == comp_id) {
			*direction = SNDRV_PCM_STREAM_CAPTURE;
			return spcm;
		}
	}

	return NULL;
}

struct snd_sof_pcm *snd_sof_find_spcm_pcm_id(struct snd_sof_dev *sdev,
					     unsigned int pcm_id)
{
	struct snd_sof_pcm *spcm;

	list_for_each_entry(spcm, &sdev->pcm_list, list) {
		if (le32_to_cpu(spcm->pcm.pcm_id) == pcm_id)
			return spcm;
	}

	return NULL;
}

struct snd_sof_widget *snd_sof_find_swidget(struct snd_sof_dev *sdev,
					    const char *name)
{
	struct snd_sof_widget *swidget;

	list_for_each_entry(swidget, &sdev->widget_list, list) {
		if (strcmp(name, swidget->widget->name) == 0)
			return swidget;
	}

	return NULL;
}

/* find widget by stream name and direction */
struct snd_sof_widget *snd_sof_find_swidget_sname(struct snd_sof_dev *sdev,
						  const char *pcm_name, int dir)
{
	struct snd_sof_widget *swidget;
	enum snd_soc_dapm_type type;

	if (dir == SNDRV_PCM_STREAM_PLAYBACK)
		type = snd_soc_dapm_aif_in;
	else
		type = snd_soc_dapm_aif_out;

	list_for_each_entry(swidget, &sdev->widget_list, list) {
		if (!strcmp(pcm_name, swidget->widget->sname) && swidget->id == type)
			return swidget;
	}

	return NULL;
}

struct snd_sof_dai *snd_sof_find_dai(struct snd_sof_dev *sdev,
				     const char *name)
{
	struct snd_sof_dai *dai;

	list_for_each_entry(dai, &sdev->dai_list, list) {
		if (dai->name && (strcmp(name, dai->name) == 0))
			return dai;
	}

	return NULL;
}

/*
 * FW Panic/fault handling.
 */

struct sof_panic_msg {
	u32 id;
	const char *msg;
};

/* standard FW panic types */
static const struct sof_panic_msg panic_msg[] = {
	{SOF_IPC_PANIC_MEM, "out of memory"},
	{SOF_IPC_PANIC_WORK, "work subsystem init failed"},
	{SOF_IPC_PANIC_IPC, "IPC subsystem init failed"},
	{SOF_IPC_PANIC_ARCH, "arch init failed"},
	{SOF_IPC_PANIC_PLATFORM, "platform init failed"},
	{SOF_IPC_PANIC_TASK, "scheduler init failed"},
	{SOF_IPC_PANIC_EXCEPTION, "runtime exception"},
	{SOF_IPC_PANIC_DEADLOCK, "deadlock"},
	{SOF_IPC_PANIC_STACK, "stack overflow"},
	{SOF_IPC_PANIC_IDLE, "can't enter idle"},
	{SOF_IPC_PANIC_WFI, "invalid wait state"},
	{SOF_IPC_PANIC_ASSERT, "assertion failed"},
};

/*
 * helper to be called from .dbg_dump callbacks. No error code is
 * provided, it's left as an exercise for the caller of .dbg_dump
 * (typically IPC or loader)
 */
void snd_sof_get_status(struct snd_sof_dev *sdev, u32 panic_code,
			u32 tracep_code, void *oops,
			struct sof_ipc_panic_info *panic_info,
			void *stack, size_t stack_words)
{
	u32 code;
	int i;

	/* is firmware dead ? */
	if ((panic_code & SOF_IPC_PANIC_MAGIC_MASK) != SOF_IPC_PANIC_MAGIC) {
		dev_err(sdev->dev, "error: unexpected fault 0x%8.8x trace 0x%8.8x\n",
			panic_code, tracep_code);
		return; /* no fault ? */
	}

	code = panic_code & (SOF_IPC_PANIC_MAGIC_MASK | SOF_IPC_PANIC_CODE_MASK);

	for (i = 0; i < ARRAY_SIZE(panic_msg); i++) {
		if (panic_msg[i].id == code) {
			dev_err(sdev->dev, "error: %s\n", panic_msg[i].msg);
			dev_err(sdev->dev, "error: trace point %8.8x\n",
				tracep_code);
			goto out;
		}
	}

	/* unknown error */
	dev_err(sdev->dev, "error: unknown reason %8.8x\n", panic_code);
	dev_err(sdev->dev, "error: trace point %8.8x\n", tracep_code);

out:
	dev_err(sdev->dev, "error: panic at %s:%d\n",
		panic_info->filename, panic_info->linenum);
	sof_oops(sdev, oops);
	sof_stack(sdev, oops, stack, stack_words);
}
EXPORT_SYMBOL(snd_sof_get_status);

/*
 * Generic buffer page table creation.
 * Take the each physical page address and drop the least significant unused
 * bits from each (based on PAGE_SIZE). Then pack valid page address bits
 * into compressed page table.
 */

int snd_sof_create_page_table(struct snd_sof_dev *sdev,
			      struct snd_dma_buffer *dmab,
			      unsigned char *page_table, size_t size)
{
	int i, pages;

	pages = snd_sgbuf_aligned_pages(size);

	dev_dbg(sdev->dev, "generating page table for %p size 0x%zx pages %d\n",
		dmab->area, size, pages);

	for (i = 0; i < pages; i++) {
		/*
		 * The number of valid address bits for each page is 20.
		 * idx determines the byte position within page_table
		 * where the current page's address is stored
		 * in the compressed page_table.
		 * This can be calculated by multiplying the page number by 2.5.
		 */
		u32 idx = (5 * i) >> 1;
		u32 pfn = snd_sgbuf_get_addr(dmab, i * PAGE_SIZE) >> PAGE_SHIFT;
		u8 *pg_table;

		dev_vdbg(sdev->dev, "pfn i %i idx %d pfn %x\n", i, idx, pfn);

		pg_table = (u8 *)(page_table + idx);

		/*
		 * pagetable compression:
		 * byte 0     byte 1     byte 2     byte 3     byte 4     byte 5
		 * ___________pfn 0__________ __________pfn 1___________  _pfn 2...
		 * .... ....  .... ....  .... ....  .... ....  .... ....  ....
		 * It is created by:
		 * 1. set current location to 0, PFN index i to 0
		 * 2. put pfn[i] at current location in Little Endian byte order
		 * 3. calculate an intermediate value as
		 *    x = (pfn[i+1] << 4) | (pfn[i] & 0xf)
		 * 4. put x at offset (current location + 2) in LE byte order
		 * 5. increment current location by 5 bytes, increment i by 2
		 * 6. continue to (2)
		 */
		if (i & 1)
			put_unaligned_le32((pg_table[0] & 0xf) | pfn << 4,
					   pg_table);
		else
			put_unaligned_le32(pfn, pg_table);
	}

	return pages;
}

/*
 * SOF Driver enumeration.
 */
static int sof_machine_check(struct snd_sof_dev *sdev)
{
	struct snd_sof_pdata *plat_data = sdev->pdata;
	struct snd_soc_acpi_mach *machine;
	int ret;

	if (plat_data->machine)
		return 0;

#if !IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC)
	dev_err(sdev->dev, "error: no matching ASoC machine driver found - aborting probe\n");
	return -ENODEV;
#else
	/* fallback to nocodec mode */
	dev_warn(sdev->dev, "No ASoC machine driver found - using nocodec\n");
	machine = devm_kzalloc(sdev->dev, sizeof(*machine), GFP_KERNEL);
	if (!machine)
		return -ENOMEM;

	ret = sof_nocodec_setup(sdev->dev, plat_data, machine,
				plat_data->desc, plat_data->desc->ops);
	if (ret < 0)
		return ret;

	plat_data->machine = machine;

	return 0;
#endif
}

static int sof_probe_continue(struct snd_sof_dev *sdev)
{
	struct snd_sof_pdata *plat_data = sdev->pdata;
	const char *drv_name;
	const void *mach;
	int size;
	int ret;

	/* probe the DSP hardware */
	ret = snd_sof_probe(sdev);
	if (ret < 0) {
		dev_err(sdev->dev, "error: failed to probe DSP %d\n", ret);
		return ret;
	}

	/* check machine info */
	ret = sof_machine_check(sdev);
	if (ret < 0) {
		dev_err(sdev->dev, "error: failed to get machine info %d\n",
			ret);
		goto dbg_err;
	}

	/* set up platform component driver */
	snd_sof_new_platform_drv(sdev);

	/* register any debug/trace capabilities */
	ret = snd_sof_dbg_init(sdev);
	if (ret < 0) {
		/*
		 * debugfs issues are suppressed in snd_sof_dbg_init() since
		 * we cannot rely on debugfs
		 * here we trap errors due to memory allocation only.
		 */
		dev_err(sdev->dev, "error: failed to init DSP trace/debug %d\n",
			ret);
		goto dbg_err;
	}

	/* init the IPC */
	sdev->ipc = snd_sof_ipc_init(sdev);
	if (!sdev->ipc) {
		dev_err(sdev->dev, "error: failed to init DSP IPC %d\n", ret);
		goto ipc_err;
	}

	/* load the firmware */
	ret = snd_sof_load_firmware(sdev);
	if (ret < 0) {
		dev_err(sdev->dev, "error: failed to load DSP firmware %d\n",
			ret);
		goto fw_load_err;
	}

	/* boot the firmware */
	ret = snd_sof_run_firmware(sdev);
	if (ret < 0) {
		dev_err(sdev->dev, "error: failed to boot DSP firmware %d\n",
			ret);
		goto fw_run_err;
	}

	/* init DMA trace */
	ret = snd_sof_init_trace(sdev);
	if (ret < 0) {
		/* non fatal */
		dev_warn(sdev->dev,
			 "warning: failed to initialize trace %d\n", ret);
	}

	/* hereafter all FW boot flows are for PM reasons */
	sdev->first_boot = false;

	/* now register audio DSP platform driver and dai */
	ret = devm_snd_soc_register_component(sdev->dev, &sdev->plat_drv,
					      sof_ops(sdev)->drv,
					      sof_ops(sdev)->num_drv);
	if (ret < 0) {
		dev_err(sdev->dev,
			"error: failed to register DSP DAI driver %d\n", ret);
		goto fw_run_err;
	}

	drv_name = plat_data->machine->drv_name;
	mach = (const void *)plat_data->machine;
	size = sizeof(*plat_data->machine);

	/* register machine driver, pass machine info as pdata */
	plat_data->pdev_mach =
		platform_device_register_data(sdev->dev, drv_name,
					      PLATFORM_DEVID_NONE, mach, size);

	if (IS_ERR(plat_data->pdev_mach)) {
		ret = PTR_ERR(plat_data->pdev_mach);
		goto comp_err;
	}

	dev_dbg(sdev->dev, "created machine %s\n",
		dev_name(&plat_data->pdev_mach->dev));

	if (plat_data->sof_probe_complete)
		plat_data->sof_probe_complete(sdev->dev);

	return 0;

comp_err:
	snd_soc_unregister_component(sdev->dev);
fw_run_err:
	snd_sof_fw_unload(sdev);
fw_load_err:
	snd_sof_ipc_free(sdev);
ipc_err:
	snd_sof_free_debug(sdev);
dbg_err:
	snd_sof_remove(sdev);

	return ret;
}

static void sof_probe_work(struct work_struct *work)
{
	struct snd_sof_dev *sdev =
		container_of(work, struct snd_sof_dev, probe_work);
	int ret;

	ret = sof_probe_continue(sdev);
	if (ret < 0) {
		/* errors cannot be propagated, log */
		dev_err(sdev->dev, "error: %s failed err: %d\n", __func__, ret);
	}
}

int snd_sof_device_probe(struct device *dev, struct snd_sof_pdata *plat_data)
{
	struct snd_sof_dev *sdev;

	sdev = devm_kzalloc(dev, sizeof(*sdev), GFP_KERNEL);
	if (!sdev)
		return -ENOMEM;

	/* initialize sof device */
	sdev->dev = dev;

	sdev->pdata = plat_data;
	sdev->first_boot = true;
	dev_set_drvdata(dev, sdev);

	/* check all mandatory ops */
	if (!sof_ops(sdev) || !sof_ops(sdev)->probe || !sof_ops(sdev)->run ||
	    !sof_ops(sdev)->block_read || !sof_ops(sdev)->block_write ||
	    !sof_ops(sdev)->send_msg || !sof_ops(sdev)->load_firmware ||
	    !sof_ops(sdev)->ipc_msg_data || !sof_ops(sdev)->ipc_pcm_params)
		return -EINVAL;

	INIT_LIST_HEAD(&sdev->pcm_list);
	INIT_LIST_HEAD(&sdev->kcontrol_list);
	INIT_LIST_HEAD(&sdev->widget_list);
	INIT_LIST_HEAD(&sdev->dai_list);
	INIT_LIST_HEAD(&sdev->route_list);
	spin_lock_init(&sdev->ipc_lock);
	spin_lock_init(&sdev->hw_lock);

	if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE))
		INIT_WORK(&sdev->probe_work, sof_probe_work);

	/* set default timeouts if none provided */
	if (plat_data->desc->ipc_timeout == 0)
		sdev->ipc_timeout = TIMEOUT_DEFAULT_IPC_MS;
	else
		sdev->ipc_timeout = plat_data->desc->ipc_timeout;
	if (plat_data->desc->boot_timeout == 0)
		sdev->boot_timeout = TIMEOUT_DEFAULT_BOOT_MS;
	else
		sdev->boot_timeout = plat_data->desc->boot_timeout;

	if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE)) {
		schedule_work(&sdev->probe_work);
		return 0;
	}

	return sof_probe_continue(sdev);
}
EXPORT_SYMBOL(snd_sof_device_probe);

int snd_sof_device_remove(struct device *dev)
{
	struct snd_sof_dev *sdev = dev_get_drvdata(dev);
	struct snd_sof_pdata *pdata = sdev->pdata;

	if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE))
		cancel_work_sync(&sdev->probe_work);

	snd_sof_fw_unload(sdev);
	snd_sof_ipc_free(sdev);
	snd_sof_free_debug(sdev);
	snd_sof_free_trace(sdev);
	snd_sof_remove(sdev);

	/*
	 * Unregister machine driver. This will unbind the snd_card which
	 * will remove the component driver and unload the topology
	 * before freeing the snd_card.
	 */
	if (!IS_ERR_OR_NULL(pdata->pdev_mach))
		platform_device_unregister(pdata->pdev_mach);

	/* release firmware */
	release_firmware(pdata->fw);
	pdata->fw = NULL;

	return 0;
}
EXPORT_SYMBOL(snd_sof_device_remove);

MODULE_AUTHOR("Liam Girdwood");
MODULE_DESCRIPTION("Sound Open Firmware (SOF) Core");
MODULE_LICENSE("Dual BSD/GPL");
MODULE_ALIAS("platform:sof-audio");
Commit	Line	Data
c16211d6 LG	1	// SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
	2	//
	3	// This file is provided under a dual BSD/GPLv2 license. When using or
	4	// redistributing this file, you may do so under either license.
	5	//
	6	// Copyright(c) 2018 Intel Corporation. All rights reserved.
	7	//
	8	// Author: Liam Girdwood <liam.r.girdwood@linux.intel.com>
	9	//
	10
	11	#include <linux/firmware.h>
	12	#include <linux/module.h>
	13	#include <asm/unaligned.h>
	14	#include <sound/soc.h>
	15	#include <sound/sof.h>
	16	#include "sof-priv.h"
	17	#include "ops.h"
	18
	19	/* SOF defaults if not provided by the platform in ms */
	20	#define TIMEOUT_DEFAULT_IPC_MS 5
	21	#define TIMEOUT_DEFAULT_BOOT_MS 100
	22
	23	/*
	24	* Generic object lookup APIs.
	25	*/
	26
	27	struct snd_sof_pcm snd_sof_find_spcm_name(struct snd_sof_dev sdev,
	28	const char *name)
	29	{
	30	struct snd_sof_pcm *spcm;
	31
	32	list_for_each_entry(spcm, &sdev->pcm_list, list) {
	33	/* match with PCM dai name */
	34	if (strcmp(spcm->pcm.dai_name, name) == 0)
	35	return spcm;
	36
	37	/* match with playback caps name if set */
	38	if (*spcm->pcm.caps[0].name &&
	39	!strcmp(spcm->pcm.caps[0].name, name))
	40	return spcm;
	41
	42	/* match with capture caps name if set */
	43	if (*spcm->pcm.caps[1].name &&
	44	!strcmp(spcm->pcm.caps[1].name, name))
	45	return spcm;
	46	}
	47
	48	return NULL;
	49	}
	50
	51	struct snd_sof_pcm snd_sof_find_spcm_comp(struct snd_sof_dev sdev,
	52	unsigned int comp_id,
	53	int *direction)
	54	{
	55	struct snd_sof_pcm *spcm;
	56
	57	list_for_each_entry(spcm, &sdev->pcm_list, list) {
	58	if (spcm->stream[SNDRV_PCM_STREAM_PLAYBACK].comp_id == comp_id) {
	59	*direction = SNDRV_PCM_STREAM_PLAYBACK;
	60	return spcm;
	61	}
	62	if (spcm->stream[SNDRV_PCM_STREAM_CAPTURE].comp_id == comp_id) {
	63	*direction = SNDRV_PCM_STREAM_CAPTURE;
	64	return spcm;
65	}
66	}
67
68	return NULL;
69	}
70
71	struct snd_sof_pcm snd_sof_find_spcm_pcm_id(struct snd_sof_dev sdev,
72	unsigned int pcm_id)
73	{
74	struct snd_sof_pcm *spcm;
75
76	list_for_each_entry(spcm, &sdev->pcm_list, list) {
77	if (le32_to_cpu(spcm->pcm.pcm_id) == pcm_id)
78	return spcm;
79	}
80
81	return NULL;
82	}
83
84	struct snd_sof_widget snd_sof_find_swidget(struct snd_sof_dev sdev,
85	const char *name)
86	{
87	struct snd_sof_widget *swidget;
88
89	list_for_each_entry(swidget, &sdev->widget_list, list) {
90	if (strcmp(name, swidget->widget->name) == 0)
91	return swidget;
92	}
93
94	return NULL;
95	}
96
97	/* find widget by stream name and direction */
98	struct snd_sof_widget snd_sof_find_swidget_sname(struct snd_sof_dev sdev,
99	const char *pcm_name, int dir)
100	{
101	struct snd_sof_widget *swidget;
102	enum snd_soc_dapm_type type;
103
104	if (dir == SNDRV_PCM_STREAM_PLAYBACK)
105	type = snd_soc_dapm_aif_in;
106	else
107	type = snd_soc_dapm_aif_out;
108
109	list_for_each_entry(swidget, &sdev->widget_list, list) {
110	if (!strcmp(pcm_name, swidget->widget->sname) && swidget->id == type)
111	return swidget;
112	}
113
114	return NULL;
115	}
116
117	struct snd_sof_dai snd_sof_find_dai(struct snd_sof_dev sdev,
118	const char *name)
119	{
120	struct snd_sof_dai *dai;
121
122	list_for_each_entry(dai, &sdev->dai_list, list) {
123	if (dai->name && (strcmp(name, dai->name) == 0))
124	return dai;
125	}
126
127	return NULL;
128	}
129
130	/*
131	* FW Panic/fault handling.
132	*/
133
134	struct sof_panic_msg {
135	u32 id;
136	const char *msg;
137	};
138
139	/* standard FW panic types */
140	static const struct sof_panic_msg panic_msg[] = {
141	{SOF_IPC_PANIC_MEM, "out of memory"},
142	{SOF_IPC_PANIC_WORK, "work subsystem init failed"},
143	{SOF_IPC_PANIC_IPC, "IPC subsystem init failed"},
144	{SOF_IPC_PANIC_ARCH, "arch init failed"},
145	{SOF_IPC_PANIC_PLATFORM, "platform init failed"},
146	{SOF_IPC_PANIC_TASK, "scheduler init failed"},
147	{SOF_IPC_PANIC_EXCEPTION, "runtime exception"},
148	{SOF_IPC_PANIC_DEADLOCK, "deadlock"},
149	{SOF_IPC_PANIC_STACK, "stack overflow"},
150	{SOF_IPC_PANIC_IDLE, "can't enter idle"},
151	{SOF_IPC_PANIC_WFI, "invalid wait state"},
152	{SOF_IPC_PANIC_ASSERT, "assertion failed"},
153	};
154
155	/*
156	* helper to be called from .dbg_dump callbacks. No error code is
157	* provided, it's left as an exercise for the caller of .dbg_dump
158	* (typically IPC or loader)
159	*/
160	void snd_sof_get_status(struct snd_sof_dev *sdev, u32 panic_code,
161	u32 tracep_code, void *oops,
162	struct sof_ipc_panic_info *panic_info,
163	void *stack, size_t stack_words)
164	{
165	u32 code;
166	int i;
167
168	/* is firmware dead ? */
169	if ((panic_code & SOF_IPC_PANIC_MAGIC_MASK) != SOF_IPC_PANIC_MAGIC) {
170	dev_err(sdev->dev, "error: unexpected fault 0x%8.8x trace 0x%8.8x\n",
171	panic_code, tracep_code);
172	return; /* no fault ? */
173	}
174
175	code = panic_code & (SOF_IPC_PANIC_MAGIC_MASK \| SOF_IPC_PANIC_CODE_MASK);
176
177	for (i = 0; i < ARRAY_SIZE(panic_msg); i++) {
178	if (panic_msg[i].id == code) {
179	dev_err(sdev->dev, "error: %s\n", panic_msg[i].msg);
180	dev_err(sdev->dev, "error: trace point %8.8x\n",
181	tracep_code);
182	goto out;
183	}
184	}
185
186	/* unknown error */
187	dev_err(sdev->dev, "error: unknown reason %8.8x\n", panic_code);
188	dev_err(sdev->dev, "error: trace point %8.8x\n", tracep_code);
189
190	out:
191	dev_err(sdev->dev, "error: panic at %s:%d\n",
192	panic_info->filename, panic_info->linenum);
193	sof_oops(sdev, oops);
194	sof_stack(sdev, oops, stack, stack_words);
195	}
196	EXPORT_SYMBOL(snd_sof_get_status);
197
198	/*
199	* Generic buffer page table creation.
200	* Take the each physical page address and drop the least significant unused
201	* bits from each (based on PAGE_SIZE). Then pack valid page address bits
202	* into compressed page table.
203	*/
204
205	int snd_sof_create_page_table(struct snd_sof_dev *sdev,
206	struct snd_dma_buffer *dmab,
207	unsigned char *page_table, size_t size)
208	{
209	int i, pages;
210
211	pages = snd_sgbuf_aligned_pages(size);
212
213	dev_dbg(sdev->dev, "generating page table for %p size 0x%zx pages %d\n",
214	dmab->area, size, pages);
215
216	for (i = 0; i < pages; i++) {
217	/*
218	* The number of valid address bits for each page is 20.
219	* idx determines the byte position within page_table
220	* where the current page's address is stored
221	* in the compressed page_table.
222	* This can be calculated by multiplying the page number by 2.5.
223	*/
224	u32 idx = (5 * i) >> 1;
225	u32 pfn = snd_sgbuf_get_addr(dmab, i * PAGE_SIZE) >> PAGE_SHIFT;
226	u8 *pg_table;
227
228	dev_vdbg(sdev->dev, "pfn i %i idx %d pfn %x\n", i, idx, pfn);
229
230	pg_table = (u8 *)(page_table + idx);
231
232	/*
233	* pagetable compression:
234	* byte 0 byte 1 byte 2 byte 3 byte 4 byte 5
235	* ___________pfn 0__________ __________pfn 1___________ _pfn 2...
236	* .... .... .... .... .... .... .... .... .... .... ....
237	* It is created by:
238	* 1. set current location to 0, PFN index i to 0
239	* 2. put pfn[i] at current location in Little Endian byte order
240	* 3. calculate an intermediate value as
241	* x = (pfn[i+1] << 4) \| (pfn[i] & 0xf)
242	* 4. put x at offset (current location + 2) in LE byte order
243	* 5. increment current location by 5 bytes, increment i by 2
244	* 6. continue to (2)
245	*/
246	if (i & 1)
247	put_unaligned_le32((pg_table[0] & 0xf) \| pfn << 4,
248	pg_table);
249	else
250	put_unaligned_le32(pfn, pg_table);
251	}
252
253	return pages;
254	}
255
256	/*
257	* SOF Driver enumeration.
258	*/
259	static int sof_machine_check(struct snd_sof_dev *sdev)
260	{
261	struct snd_sof_pdata *plat_data = sdev->pdata;
262	struct snd_soc_acpi_mach *machine;
263	int ret;
264
265	if (plat_data->machine)
266	return 0;
267
ce38a750 PLB	268	#if !IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC)
	269	dev_err(sdev->dev, "error: no matching ASoC machine driver found - aborting probe\n");
	270	return -ENODEV;
	271	#else
c16211d6 LG	272	/* fallback to nocodec mode */
	273	dev_warn(sdev->dev, "No ASoC machine driver found - using nocodec\n");
	274	machine = devm_kzalloc(sdev->dev, sizeof(*machine), GFP_KERNEL);
	275	if (!machine)
	276	return -ENOMEM;
	277
	278	ret = sof_nocodec_setup(sdev->dev, plat_data, machine,
	279	plat_data->desc, plat_data->desc->ops);
	280	if (ret < 0)
	281	return ret;
	282
	283	plat_data->machine = machine;
	284
	285	return 0;
ce38a750	286	#endif
c16211d6 LG	287	}
	288
	289	static int sof_probe_continue(struct snd_sof_dev *sdev)
	290	{
	291	struct snd_sof_pdata *plat_data = sdev->pdata;
	292	const char *drv_name;
	293	const void *mach;
	294	int size;
	295	int ret;
	296
	297	/* probe the DSP hardware */
	298	ret = snd_sof_probe(sdev);
	299	if (ret < 0) {
	300	dev_err(sdev->dev, "error: failed to probe DSP %d\n", ret);
	301	return ret;
	302	}
	303
	304	/* check machine info */
	305	ret = sof_machine_check(sdev);
	306	if (ret < 0) {
	307	dev_err(sdev->dev, "error: failed to get machine info %d\n",
	308	ret);
	309	goto dbg_err;
	310	}
	311
	312	/* set up platform component driver */
	313	snd_sof_new_platform_drv(sdev);
	314
	315	/* register any debug/trace capabilities */
	316	ret = snd_sof_dbg_init(sdev);
	317	if (ret < 0) {
	318	/*
	319	* debugfs issues are suppressed in snd_sof_dbg_init() since
	320	* we cannot rely on debugfs
	321	* here we trap errors due to memory allocation only.
	322	*/
	323	dev_err(sdev->dev, "error: failed to init DSP trace/debug %d\n",
	324	ret);
	325	goto dbg_err;
	326	}
	327
	328	/* init the IPC */
	329	sdev->ipc = snd_sof_ipc_init(sdev);
	330	if (!sdev->ipc) {
	331	dev_err(sdev->dev, "error: failed to init DSP IPC %d\n", ret);
	332	goto ipc_err;
	333	}
	334
	335	/* load the firmware */
	336	ret = snd_sof_load_firmware(sdev);
	337	if (ret < 0) {
	338	dev_err(sdev->dev, "error: failed to load DSP firmware %d\n",
	339	ret);
	340	goto fw_load_err;
	341	}
	342
	343	/* boot the firmware */
	344	ret = snd_sof_run_firmware(sdev);
	345	if (ret < 0) {
	346	dev_err(sdev->dev, "error: failed to boot DSP firmware %d\n",
	347	ret);
	348	goto fw_run_err;
	349	}
	350
351	/* init DMA trace */
352	ret = snd_sof_init_trace(sdev);
353	if (ret < 0) {
354	/* non fatal */
355	dev_warn(sdev->dev,
356	"warning: failed to initialize trace %d\n", ret);
357	}
358
359	/* hereafter all FW boot flows are for PM reasons */
360	sdev->first_boot = false;
361
362	/* now register audio DSP platform driver and dai */
363	ret = devm_snd_soc_register_component(sdev->dev, &sdev->plat_drv,
364	sof_ops(sdev)->drv,
365	sof_ops(sdev)->num_drv);
366	if (ret < 0) {
367	dev_err(sdev->dev,
368	"error: failed to register DSP DAI driver %d\n", ret);
369	goto fw_run_err;
370	}
371
372	drv_name = plat_data->machine->drv_name;
373	mach = (const void *)plat_data->machine;
374	size = sizeof(*plat_data->machine);
375
376	/* register machine driver, pass machine info as pdata */
377	plat_data->pdev_mach =
378	platform_device_register_data(sdev->dev, drv_name,
379	PLATFORM_DEVID_NONE, mach, size);
380
381	if (IS_ERR(plat_data->pdev_mach)) {
382	ret = PTR_ERR(plat_data->pdev_mach);
383	goto comp_err;
384	}
385
386	dev_dbg(sdev->dev, "created machine %s\n",
387	dev_name(&plat_data->pdev_mach->dev));
388
389	if (plat_data->sof_probe_complete)
390	plat_data->sof_probe_complete(sdev->dev);
391
392	return 0;
393
394	comp_err:
395	snd_soc_unregister_component(sdev->dev);
396	fw_run_err:
397	snd_sof_fw_unload(sdev);
398	fw_load_err:
399	snd_sof_ipc_free(sdev);
400	ipc_err:
401	snd_sof_free_debug(sdev);
402	dbg_err:
403	snd_sof_remove(sdev);
404
405	return ret;
406	}
407
408	static void sof_probe_work(struct work_struct *work)
409	{
410	struct snd_sof_dev *sdev =
411	container_of(work, struct snd_sof_dev, probe_work);
412	int ret;
413
414	ret = sof_probe_continue(sdev);
415	if (ret < 0) {
416	/* errors cannot be propagated, log */
417	dev_err(sdev->dev, "error: %s failed err: %d\n", __func__, ret);
418	}
419	}
420
421	int snd_sof_device_probe(struct device dev, struct snd_sof_pdata plat_data)
422	{
423	struct snd_sof_dev *sdev;
424
425	sdev = devm_kzalloc(dev, sizeof(*sdev), GFP_KERNEL);
426	if (!sdev)
427	return -ENOMEM;
428
429	/* initialize sof device */
430	sdev->dev = dev;
431
432	sdev->pdata = plat_data;
433	sdev->first_boot = true;
434	dev_set_drvdata(dev, sdev);
435
436	/* check all mandatory ops */
437	if (!sof_ops(sdev) \|\| !sof_ops(sdev)->probe \|\| !sof_ops(sdev)->run \|\|
438	!sof_ops(sdev)->block_read \|\| !sof_ops(sdev)->block_write \|\|
439	!sof_ops(sdev)->send_msg \|\| !sof_ops(sdev)->load_firmware \|\|
440	!sof_ops(sdev)->ipc_msg_data \|\| !sof_ops(sdev)->ipc_pcm_params)
441	return -EINVAL;
442
443	INIT_LIST_HEAD(&sdev->pcm_list);
444	INIT_LIST_HEAD(&sdev->kcontrol_list);
445	INIT_LIST_HEAD(&sdev->widget_list);
446	INIT_LIST_HEAD(&sdev->dai_list);
447	INIT_LIST_HEAD(&sdev->route_list);
448	spin_lock_init(&sdev->ipc_lock);
449	spin_lock_init(&sdev->hw_lock);
450
451	if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE))
452	INIT_WORK(&sdev->probe_work, sof_probe_work);
453
454	/* set default timeouts if none provided */
455	if (plat_data->desc->ipc_timeout == 0)
456	sdev->ipc_timeout = TIMEOUT_DEFAULT_IPC_MS;
457	else
458	sdev->ipc_timeout = plat_data->desc->ipc_timeout;
459	if (plat_data->desc->boot_timeout == 0)
460	sdev->boot_timeout = TIMEOUT_DEFAULT_BOOT_MS;
461	else
462	sdev->boot_timeout = plat_data->desc->boot_timeout;
463
464	if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE)) {
465	schedule_work(&sdev->probe_work);
466	return 0;
467	}
468
469	return sof_probe_continue(sdev);
470	}
471	EXPORT_SYMBOL(snd_sof_device_probe);
472
473	int snd_sof_device_remove(struct device *dev)
474	{
475	struct snd_sof_dev *sdev = dev_get_drvdata(dev);
476	struct snd_sof_pdata *pdata = sdev->pdata;
477
478	if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE))
479	cancel_work_sync(&sdev->probe_work);
480
481	snd_sof_fw_unload(sdev);
482	snd_sof_ipc_free(sdev);
483	snd_sof_free_debug(sdev);
484	snd_sof_free_trace(sdev);
485	snd_sof_remove(sdev);
486
487	/*
488	* Unregister machine driver. This will unbind the snd_card which
489	* will remove the component driver and unload the topology
490	* before freeing the snd_card.
491	*/
492	if (!IS_ERR_OR_NULL(pdata->pdev_mach))
493	platform_device_unregister(pdata->pdev_mach);
494
495	/* release firmware */
496	release_firmware(pdata->fw);
497	pdata->fw = NULL;
498
499	return 0;
500	}
501	EXPORT_SYMBOL(snd_sof_device_remove);
502
503	MODULE_AUTHOR("Liam Girdwood");
504	MODULE_DESCRIPTION("Sound Open Firmware (SOF) Core");
505	MODULE_LICENSE("Dual BSD/GPL");
506	MODULE_ALIAS("platform:sof-audio");