xref: /openbmc/linux/sound/firewire/fireworks/fireworks_command.c (revision 75bf465f0bc33e9b776a46d6a1b9b990f5fb7c37)
1*da607e19SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2bde8a8f2STakashi Sakamoto /*
3bde8a8f2STakashi Sakamoto  * fireworks_command.c - a part of driver for Fireworks based devices
4bde8a8f2STakashi Sakamoto  *
5bde8a8f2STakashi Sakamoto  * Copyright (c) 2013-2014 Takashi Sakamoto
6bde8a8f2STakashi Sakamoto  */
7bde8a8f2STakashi Sakamoto 
8bde8a8f2STakashi Sakamoto #include "./fireworks.h"
9bde8a8f2STakashi Sakamoto 
10bde8a8f2STakashi Sakamoto /*
11bde8a8f2STakashi Sakamoto  * This driver uses transaction version 1 or later to use extended hardware
12bde8a8f2STakashi Sakamoto  * information. Then too old devices are not available.
13bde8a8f2STakashi Sakamoto  *
14bde8a8f2STakashi Sakamoto  * Each commands are not required to have continuous sequence numbers. This
15bde8a8f2STakashi Sakamoto  * number is just used to match command and response.
16bde8a8f2STakashi Sakamoto  *
17bde8a8f2STakashi Sakamoto  * This module support a part of commands. Please see FFADO if you want to see
18bde8a8f2STakashi Sakamoto  * whole commands. But there are some commands which FFADO don't implement.
19bde8a8f2STakashi Sakamoto  *
20bde8a8f2STakashi Sakamoto  * Fireworks also supports AV/C general commands and AV/C Stream Format
21bde8a8f2STakashi Sakamoto  * Information commands. But this module don't use them.
22bde8a8f2STakashi Sakamoto  */
23bde8a8f2STakashi Sakamoto 
24555e8a8fSTakashi Sakamoto #define KERNEL_SEQNUM_MIN	(SND_EFW_TRANSACTION_USER_SEQNUM_MAX + 2)
25555e8a8fSTakashi Sakamoto #define KERNEL_SEQNUM_MAX	((u32)~0)
26bde8a8f2STakashi Sakamoto 
27bde8a8f2STakashi Sakamoto /* for clock source and sampling rate */
28bde8a8f2STakashi Sakamoto struct efc_clock {
29bde8a8f2STakashi Sakamoto 	u32 source;
30bde8a8f2STakashi Sakamoto 	u32 sampling_rate;
31bde8a8f2STakashi Sakamoto 	u32 index;
32bde8a8f2STakashi Sakamoto };
33bde8a8f2STakashi Sakamoto 
34bde8a8f2STakashi Sakamoto /* command categories */
35bde8a8f2STakashi Sakamoto enum efc_category {
36bde8a8f2STakashi Sakamoto 	EFC_CAT_HWINFO		= 0,
37bde8a8f2STakashi Sakamoto 	EFC_CAT_TRANSPORT	= 2,
38bde8a8f2STakashi Sakamoto 	EFC_CAT_HWCTL		= 3,
39bde8a8f2STakashi Sakamoto };
40bde8a8f2STakashi Sakamoto 
41bde8a8f2STakashi Sakamoto /* hardware info category commands */
42bde8a8f2STakashi Sakamoto enum efc_cmd_hwinfo {
43bde8a8f2STakashi Sakamoto 	EFC_CMD_HWINFO_GET_CAPS		= 0,
44bde8a8f2STakashi Sakamoto 	EFC_CMD_HWINFO_GET_POLLED	= 1,
45bde8a8f2STakashi Sakamoto 	EFC_CMD_HWINFO_SET_RESP_ADDR	= 2
46bde8a8f2STakashi Sakamoto };
47bde8a8f2STakashi Sakamoto 
48bde8a8f2STakashi Sakamoto enum efc_cmd_transport {
49bde8a8f2STakashi Sakamoto 	EFC_CMD_TRANSPORT_SET_TX_MODE	= 0
50bde8a8f2STakashi Sakamoto };
51bde8a8f2STakashi Sakamoto 
52bde8a8f2STakashi Sakamoto /* hardware control category commands */
53bde8a8f2STakashi Sakamoto enum efc_cmd_hwctl {
54bde8a8f2STakashi Sakamoto 	EFC_CMD_HWCTL_SET_CLOCK		= 0,
55bde8a8f2STakashi Sakamoto 	EFC_CMD_HWCTL_GET_CLOCK		= 1,
56bde8a8f2STakashi Sakamoto 	EFC_CMD_HWCTL_IDENTIFY		= 5
57bde8a8f2STakashi Sakamoto };
58bde8a8f2STakashi Sakamoto 
59bde8a8f2STakashi Sakamoto /* return values in response */
60bde8a8f2STakashi Sakamoto enum efr_status {
61bde8a8f2STakashi Sakamoto 	EFR_STATUS_OK			= 0,
62bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD			= 1,
63bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_COMMAND		= 2,
64bde8a8f2STakashi Sakamoto 	EFR_STATUS_COMM_ERR		= 3,
65bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_QUAD_COUNT	= 4,
66bde8a8f2STakashi Sakamoto 	EFR_STATUS_UNSUPPORTED		= 5,
67bde8a8f2STakashi Sakamoto 	EFR_STATUS_1394_TIMEOUT		= 6,
68bde8a8f2STakashi Sakamoto 	EFR_STATUS_DSP_TIMEOUT		= 7,
69bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_RATE		= 8,
70bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_CLOCK		= 9,
71bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_CHANNEL		= 10,
72bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_PAN		= 11,
73bde8a8f2STakashi Sakamoto 	EFR_STATUS_FLASH_BUSY		= 12,
74bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_MIRROR		= 13,
75bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_LED		= 14,
76bde8a8f2STakashi Sakamoto 	EFR_STATUS_BAD_PARAMETER	= 15,
77bde8a8f2STakashi Sakamoto 	EFR_STATUS_INCOMPLETE		= 0x80000000
78bde8a8f2STakashi Sakamoto };
79bde8a8f2STakashi Sakamoto 
80bde8a8f2STakashi Sakamoto static const char *const efr_status_names[] = {
81bde8a8f2STakashi Sakamoto 	[EFR_STATUS_OK]			= "OK",
82bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD]		= "bad",
83bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_COMMAND]	= "bad command",
84bde8a8f2STakashi Sakamoto 	[EFR_STATUS_COMM_ERR]		= "comm err",
85bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_QUAD_COUNT]	= "bad quad count",
86bde8a8f2STakashi Sakamoto 	[EFR_STATUS_UNSUPPORTED]	= "unsupported",
87bde8a8f2STakashi Sakamoto 	[EFR_STATUS_1394_TIMEOUT]	= "1394 timeout",
88bde8a8f2STakashi Sakamoto 	[EFR_STATUS_DSP_TIMEOUT]	= "DSP timeout",
89bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_RATE]		= "bad rate",
90bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_CLOCK]		= "bad clock",
91bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_CHANNEL]	= "bad channel",
92bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_PAN]		= "bad pan",
93bde8a8f2STakashi Sakamoto 	[EFR_STATUS_FLASH_BUSY]		= "flash busy",
94bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_MIRROR]		= "bad mirror",
95bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_LED]		= "bad LED",
96bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_PARAMETER]	= "bad parameter",
97bde8a8f2STakashi Sakamoto 	[EFR_STATUS_BAD_PARAMETER + 1]	= "incomplete"
98bde8a8f2STakashi Sakamoto };
99bde8a8f2STakashi Sakamoto 
100bde8a8f2STakashi Sakamoto static int
efw_transaction(struct snd_efw * efw,unsigned int category,unsigned int command,const __be32 * params,unsigned int param_bytes,const __be32 * resp,unsigned int resp_bytes)101bde8a8f2STakashi Sakamoto efw_transaction(struct snd_efw *efw, unsigned int category,
102bde8a8f2STakashi Sakamoto 		unsigned int command,
103bde8a8f2STakashi Sakamoto 		const __be32 *params, unsigned int param_bytes,
104bde8a8f2STakashi Sakamoto 		const __be32 *resp, unsigned int resp_bytes)
105bde8a8f2STakashi Sakamoto {
106bde8a8f2STakashi Sakamoto 	struct snd_efw_transaction *header;
107bde8a8f2STakashi Sakamoto 	__be32 *buf;
108bde8a8f2STakashi Sakamoto 	u32 seqnum;
109bde8a8f2STakashi Sakamoto 	unsigned int buf_bytes, cmd_bytes;
110bde8a8f2STakashi Sakamoto 	int err;
111bde8a8f2STakashi Sakamoto 
112bde8a8f2STakashi Sakamoto 	/* calculate buffer size*/
113bde8a8f2STakashi Sakamoto 	buf_bytes = sizeof(struct snd_efw_transaction) +
114bde8a8f2STakashi Sakamoto 		    max(param_bytes, resp_bytes);
115bde8a8f2STakashi Sakamoto 
116bde8a8f2STakashi Sakamoto 	/* keep buffer */
117bde8a8f2STakashi Sakamoto 	buf = kzalloc(buf_bytes, GFP_KERNEL);
118bde8a8f2STakashi Sakamoto 	if (buf == NULL)
119bde8a8f2STakashi Sakamoto 		return -ENOMEM;
120bde8a8f2STakashi Sakamoto 
121bde8a8f2STakashi Sakamoto 	/* to keep consistency of sequence number */
122bde8a8f2STakashi Sakamoto 	spin_lock(&efw->lock);
123555e8a8fSTakashi Sakamoto 	if ((efw->seqnum < KERNEL_SEQNUM_MIN) ||
124555e8a8fSTakashi Sakamoto 	    (efw->seqnum >= KERNEL_SEQNUM_MAX - 2))
125555e8a8fSTakashi Sakamoto 		efw->seqnum = KERNEL_SEQNUM_MIN;
126bde8a8f2STakashi Sakamoto 	else
127bde8a8f2STakashi Sakamoto 		efw->seqnum += 2;
128bde8a8f2STakashi Sakamoto 	seqnum = efw->seqnum;
129bde8a8f2STakashi Sakamoto 	spin_unlock(&efw->lock);
130bde8a8f2STakashi Sakamoto 
131bde8a8f2STakashi Sakamoto 	/* fill transaction header fields */
132bde8a8f2STakashi Sakamoto 	cmd_bytes = sizeof(struct snd_efw_transaction) + param_bytes;
133bde8a8f2STakashi Sakamoto 	header = (struct snd_efw_transaction *)buf;
134bde8a8f2STakashi Sakamoto 	header->length	 = cpu_to_be32(cmd_bytes / sizeof(__be32));
135bde8a8f2STakashi Sakamoto 	header->version	 = cpu_to_be32(1);
136bde8a8f2STakashi Sakamoto 	header->seqnum	 = cpu_to_be32(seqnum);
137bde8a8f2STakashi Sakamoto 	header->category = cpu_to_be32(category);
138bde8a8f2STakashi Sakamoto 	header->command	 = cpu_to_be32(command);
139bde8a8f2STakashi Sakamoto 	header->status	 = 0;
140bde8a8f2STakashi Sakamoto 
141bde8a8f2STakashi Sakamoto 	/* fill transaction command parameters */
142bde8a8f2STakashi Sakamoto 	memcpy(header->params, params, param_bytes);
143bde8a8f2STakashi Sakamoto 
144bde8a8f2STakashi Sakamoto 	err = snd_efw_transaction_run(efw->unit, buf, cmd_bytes,
145bde8a8f2STakashi Sakamoto 				      buf, buf_bytes);
146bde8a8f2STakashi Sakamoto 	if (err < 0)
147bde8a8f2STakashi Sakamoto 		goto end;
148bde8a8f2STakashi Sakamoto 
149bde8a8f2STakashi Sakamoto 	/* check transaction header fields */
150bde8a8f2STakashi Sakamoto 	if ((be32_to_cpu(header->version) < 1) ||
151bde8a8f2STakashi Sakamoto 	    (be32_to_cpu(header->category) != category) ||
152bde8a8f2STakashi Sakamoto 	    (be32_to_cpu(header->command) != command) ||
153bde8a8f2STakashi Sakamoto 	    (be32_to_cpu(header->status) != EFR_STATUS_OK)) {
154bde8a8f2STakashi Sakamoto 		dev_err(&efw->unit->device, "EFW command failed [%u/%u]: %s\n",
155bde8a8f2STakashi Sakamoto 			be32_to_cpu(header->category),
156bde8a8f2STakashi Sakamoto 			be32_to_cpu(header->command),
157bde8a8f2STakashi Sakamoto 			efr_status_names[be32_to_cpu(header->status)]);
158bde8a8f2STakashi Sakamoto 		err = -EIO;
159bde8a8f2STakashi Sakamoto 		goto end;
160bde8a8f2STakashi Sakamoto 	}
161bde8a8f2STakashi Sakamoto 
162bde8a8f2STakashi Sakamoto 	if (resp == NULL)
163bde8a8f2STakashi Sakamoto 		goto end;
164bde8a8f2STakashi Sakamoto 
165bde8a8f2STakashi Sakamoto 	/* fill transaction response parameters */
166bde8a8f2STakashi Sakamoto 	memset((void *)resp, 0, resp_bytes);
167bde8a8f2STakashi Sakamoto 	resp_bytes = min_t(unsigned int, resp_bytes,
168bde8a8f2STakashi Sakamoto 			   be32_to_cpu(header->length) * sizeof(__be32) -
169bde8a8f2STakashi Sakamoto 				sizeof(struct snd_efw_transaction));
170bde8a8f2STakashi Sakamoto 	memcpy((void *)resp, &buf[6], resp_bytes);
171bde8a8f2STakashi Sakamoto end:
172bde8a8f2STakashi Sakamoto 	kfree(buf);
173bde8a8f2STakashi Sakamoto 	return err;
174bde8a8f2STakashi Sakamoto }
175bde8a8f2STakashi Sakamoto 
176bde8a8f2STakashi Sakamoto /*
177bde8a8f2STakashi Sakamoto  * The address in host system for transaction response is changable when the
178bde8a8f2STakashi Sakamoto  * device supports. struct hwinfo.flags includes its flag. The default is
179bde8a8f2STakashi Sakamoto  * MEMORY_SPACE_EFW_RESPONSE.
180bde8a8f2STakashi Sakamoto  */
snd_efw_command_set_resp_addr(struct snd_efw * efw,u16 addr_high,u32 addr_low)181bde8a8f2STakashi Sakamoto int snd_efw_command_set_resp_addr(struct snd_efw *efw,
182bde8a8f2STakashi Sakamoto 				  u16 addr_high, u32 addr_low)
183bde8a8f2STakashi Sakamoto {
184bde8a8f2STakashi Sakamoto 	__be32 addr[2];
185bde8a8f2STakashi Sakamoto 
186bde8a8f2STakashi Sakamoto 	addr[0] = cpu_to_be32(addr_high);
187bde8a8f2STakashi Sakamoto 	addr[1] = cpu_to_be32(addr_low);
188bde8a8f2STakashi Sakamoto 
189bde8a8f2STakashi Sakamoto 	if (!efw->resp_addr_changable)
190bde8a8f2STakashi Sakamoto 		return -ENOSYS;
191bde8a8f2STakashi Sakamoto 
192bde8a8f2STakashi Sakamoto 	return efw_transaction(efw, EFC_CAT_HWCTL,
193bde8a8f2STakashi Sakamoto 			       EFC_CMD_HWINFO_SET_RESP_ADDR,
194bde8a8f2STakashi Sakamoto 			       addr, sizeof(addr), NULL, 0);
195bde8a8f2STakashi Sakamoto }
196bde8a8f2STakashi Sakamoto 
197bde8a8f2STakashi Sakamoto /*
198bde8a8f2STakashi Sakamoto  * This is for timestamp processing. In Windows mode, all 32bit fields of second
199bde8a8f2STakashi Sakamoto  * CIP header in AMDTP transmit packet is used for 'presentation timestamp'. In
200bde8a8f2STakashi Sakamoto  * 'no data' packet the value of this field is 0x90ffffff.
201bde8a8f2STakashi Sakamoto  */
snd_efw_command_set_tx_mode(struct snd_efw * efw,enum snd_efw_transport_mode mode)202bde8a8f2STakashi Sakamoto int snd_efw_command_set_tx_mode(struct snd_efw *efw,
203bde8a8f2STakashi Sakamoto 				enum snd_efw_transport_mode mode)
204bde8a8f2STakashi Sakamoto {
205bde8a8f2STakashi Sakamoto 	__be32 param = cpu_to_be32(mode);
206bde8a8f2STakashi Sakamoto 	return efw_transaction(efw, EFC_CAT_TRANSPORT,
207bde8a8f2STakashi Sakamoto 			       EFC_CMD_TRANSPORT_SET_TX_MODE,
208bde8a8f2STakashi Sakamoto 			       &param, sizeof(param), NULL, 0);
209bde8a8f2STakashi Sakamoto }
210bde8a8f2STakashi Sakamoto 
snd_efw_command_get_hwinfo(struct snd_efw * efw,struct snd_efw_hwinfo * hwinfo)211bde8a8f2STakashi Sakamoto int snd_efw_command_get_hwinfo(struct snd_efw *efw,
212bde8a8f2STakashi Sakamoto 			       struct snd_efw_hwinfo *hwinfo)
213bde8a8f2STakashi Sakamoto {
214bde8a8f2STakashi Sakamoto 	int err;
215bde8a8f2STakashi Sakamoto 
216bde8a8f2STakashi Sakamoto 	err  = efw_transaction(efw, EFC_CAT_HWINFO,
217bde8a8f2STakashi Sakamoto 			       EFC_CMD_HWINFO_GET_CAPS,
218bde8a8f2STakashi Sakamoto 			       NULL, 0, (__be32 *)hwinfo, sizeof(*hwinfo));
219bde8a8f2STakashi Sakamoto 	if (err < 0)
220bde8a8f2STakashi Sakamoto 		goto end;
221bde8a8f2STakashi Sakamoto 
222bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->flags);
223bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->guid_hi);
224bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->guid_lo);
225bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->type);
226bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->version);
227bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->supported_clocks);
228bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->amdtp_rx_pcm_channels);
229bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->amdtp_tx_pcm_channels);
230bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->phys_out);
231bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->phys_in);
232bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->phys_out_grp_count);
233bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->phys_in_grp_count);
234bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->midi_out_ports);
235bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->midi_in_ports);
236bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->max_sample_rate);
237bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->min_sample_rate);
238bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->dsp_version);
239bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->arm_version);
240bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->mixer_playback_channels);
241bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->mixer_capture_channels);
242bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->fpga_version);
243bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->amdtp_rx_pcm_channels_2x);
244bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->amdtp_tx_pcm_channels_2x);
245bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->amdtp_rx_pcm_channels_4x);
246bde8a8f2STakashi Sakamoto 	be32_to_cpus(&hwinfo->amdtp_tx_pcm_channels_4x);
247bde8a8f2STakashi Sakamoto 
248bde8a8f2STakashi Sakamoto 	/* ensure terminated */
249bde8a8f2STakashi Sakamoto 	hwinfo->vendor_name[HWINFO_NAME_SIZE_BYTES - 1] = '\0';
250bde8a8f2STakashi Sakamoto 	hwinfo->model_name[HWINFO_NAME_SIZE_BYTES  - 1] = '\0';
251bde8a8f2STakashi Sakamoto end:
252bde8a8f2STakashi Sakamoto 	return err;
253bde8a8f2STakashi Sakamoto }
254bde8a8f2STakashi Sakamoto 
snd_efw_command_get_phys_meters(struct snd_efw * efw,struct snd_efw_phys_meters * meters,unsigned int len)255bde8a8f2STakashi Sakamoto int snd_efw_command_get_phys_meters(struct snd_efw *efw,
256bde8a8f2STakashi Sakamoto 				    struct snd_efw_phys_meters *meters,
257bde8a8f2STakashi Sakamoto 				    unsigned int len)
258bde8a8f2STakashi Sakamoto {
259463543acSTakashi Sakamoto 	u32 *buf = (u32 *)meters;
260bde8a8f2STakashi Sakamoto 	unsigned int i;
261bde8a8f2STakashi Sakamoto 	int err;
262bde8a8f2STakashi Sakamoto 
263bde8a8f2STakashi Sakamoto 	err = efw_transaction(efw, EFC_CAT_HWINFO,
264bde8a8f2STakashi Sakamoto 			      EFC_CMD_HWINFO_GET_POLLED,
265bde8a8f2STakashi Sakamoto 			      NULL, 0, (__be32 *)meters, len);
266bde8a8f2STakashi Sakamoto 	if (err >= 0)
267bde8a8f2STakashi Sakamoto 		for (i = 0; i < len / sizeof(u32); i++)
268bde8a8f2STakashi Sakamoto 			be32_to_cpus(&buf[i]);
269bde8a8f2STakashi Sakamoto 
270bde8a8f2STakashi Sakamoto 	return err;
271bde8a8f2STakashi Sakamoto }
272bde8a8f2STakashi Sakamoto 
273bde8a8f2STakashi Sakamoto static int
command_get_clock(struct snd_efw * efw,struct efc_clock * clock)274bde8a8f2STakashi Sakamoto command_get_clock(struct snd_efw *efw, struct efc_clock *clock)
275bde8a8f2STakashi Sakamoto {
276bde8a8f2STakashi Sakamoto 	int err;
277bde8a8f2STakashi Sakamoto 
278bde8a8f2STakashi Sakamoto 	err = efw_transaction(efw, EFC_CAT_HWCTL,
279bde8a8f2STakashi Sakamoto 			      EFC_CMD_HWCTL_GET_CLOCK,
280bde8a8f2STakashi Sakamoto 			      NULL, 0,
281bde8a8f2STakashi Sakamoto 			      (__be32 *)clock, sizeof(struct efc_clock));
282bde8a8f2STakashi Sakamoto 	if (err >= 0) {
283bde8a8f2STakashi Sakamoto 		be32_to_cpus(&clock->source);
284bde8a8f2STakashi Sakamoto 		be32_to_cpus(&clock->sampling_rate);
285bde8a8f2STakashi Sakamoto 		be32_to_cpus(&clock->index);
286bde8a8f2STakashi Sakamoto 	}
287bde8a8f2STakashi Sakamoto 
288bde8a8f2STakashi Sakamoto 	return err;
289bde8a8f2STakashi Sakamoto }
290bde8a8f2STakashi Sakamoto 
291bde8a8f2STakashi Sakamoto /* give UINT_MAX if set nothing */
292bde8a8f2STakashi Sakamoto static int
command_set_clock(struct snd_efw * efw,unsigned int source,unsigned int rate)293bde8a8f2STakashi Sakamoto command_set_clock(struct snd_efw *efw,
294bde8a8f2STakashi Sakamoto 		  unsigned int source, unsigned int rate)
295bde8a8f2STakashi Sakamoto {
296bde8a8f2STakashi Sakamoto 	struct efc_clock clock = {0};
297bde8a8f2STakashi Sakamoto 	int err;
298bde8a8f2STakashi Sakamoto 
299bde8a8f2STakashi Sakamoto 	/* check arguments */
300bde8a8f2STakashi Sakamoto 	if ((source == UINT_MAX) && (rate == UINT_MAX)) {
301bde8a8f2STakashi Sakamoto 		err = -EINVAL;
302bde8a8f2STakashi Sakamoto 		goto end;
303bde8a8f2STakashi Sakamoto 	}
304bde8a8f2STakashi Sakamoto 
305bde8a8f2STakashi Sakamoto 	/* get current status */
306bde8a8f2STakashi Sakamoto 	err = command_get_clock(efw, &clock);
307bde8a8f2STakashi Sakamoto 	if (err < 0)
308bde8a8f2STakashi Sakamoto 		goto end;
309bde8a8f2STakashi Sakamoto 
310bde8a8f2STakashi Sakamoto 	/* no need */
311bde8a8f2STakashi Sakamoto 	if ((clock.source == source) && (clock.sampling_rate == rate))
312bde8a8f2STakashi Sakamoto 		goto end;
313bde8a8f2STakashi Sakamoto 
314bde8a8f2STakashi Sakamoto 	/* set params */
315bde8a8f2STakashi Sakamoto 	if ((source != UINT_MAX) && (clock.source != source))
316bde8a8f2STakashi Sakamoto 		clock.source = source;
317bde8a8f2STakashi Sakamoto 	if ((rate != UINT_MAX) && (clock.sampling_rate != rate))
318bde8a8f2STakashi Sakamoto 		clock.sampling_rate = rate;
319bde8a8f2STakashi Sakamoto 	clock.index = 0;
320bde8a8f2STakashi Sakamoto 
321bde8a8f2STakashi Sakamoto 	cpu_to_be32s(&clock.source);
322bde8a8f2STakashi Sakamoto 	cpu_to_be32s(&clock.sampling_rate);
323bde8a8f2STakashi Sakamoto 	cpu_to_be32s(&clock.index);
324bde8a8f2STakashi Sakamoto 
325bde8a8f2STakashi Sakamoto 	err = efw_transaction(efw, EFC_CAT_HWCTL,
326bde8a8f2STakashi Sakamoto 			      EFC_CMD_HWCTL_SET_CLOCK,
327bde8a8f2STakashi Sakamoto 			      (__be32 *)&clock, sizeof(struct efc_clock),
328bde8a8f2STakashi Sakamoto 			      NULL, 0);
329bde8a8f2STakashi Sakamoto 	if (err < 0)
330bde8a8f2STakashi Sakamoto 		goto end;
331bde8a8f2STakashi Sakamoto 
332bde8a8f2STakashi Sakamoto 	/*
333bde8a8f2STakashi Sakamoto 	 * With firmware version 5.8, just after changing clock state, these
334bde8a8f2STakashi Sakamoto 	 * parameters are not immediately retrieved by get command. In my
335bde8a8f2STakashi Sakamoto 	 * trial, there needs to be 100msec to get changed parameters.
336bde8a8f2STakashi Sakamoto 	 */
337bde8a8f2STakashi Sakamoto 	msleep(150);
338bde8a8f2STakashi Sakamoto end:
339bde8a8f2STakashi Sakamoto 	return err;
340bde8a8f2STakashi Sakamoto }
341bde8a8f2STakashi Sakamoto 
snd_efw_command_get_clock_source(struct snd_efw * efw,enum snd_efw_clock_source * source)342bde8a8f2STakashi Sakamoto int snd_efw_command_get_clock_source(struct snd_efw *efw,
343bde8a8f2STakashi Sakamoto 				     enum snd_efw_clock_source *source)
344bde8a8f2STakashi Sakamoto {
345bde8a8f2STakashi Sakamoto 	int err;
346bde8a8f2STakashi Sakamoto 	struct efc_clock clock = {0};
347bde8a8f2STakashi Sakamoto 
348bde8a8f2STakashi Sakamoto 	err = command_get_clock(efw, &clock);
349bde8a8f2STakashi Sakamoto 	if (err >= 0)
350bde8a8f2STakashi Sakamoto 		*source = clock.source;
351bde8a8f2STakashi Sakamoto 
352bde8a8f2STakashi Sakamoto 	return err;
353bde8a8f2STakashi Sakamoto }
354bde8a8f2STakashi Sakamoto 
snd_efw_command_get_sampling_rate(struct snd_efw * efw,unsigned int * rate)355bde8a8f2STakashi Sakamoto int snd_efw_command_get_sampling_rate(struct snd_efw *efw, unsigned int *rate)
356bde8a8f2STakashi Sakamoto {
357bde8a8f2STakashi Sakamoto 	int err;
358bde8a8f2STakashi Sakamoto 	struct efc_clock clock = {0};
359bde8a8f2STakashi Sakamoto 
360bde8a8f2STakashi Sakamoto 	err = command_get_clock(efw, &clock);
361bde8a8f2STakashi Sakamoto 	if (err >= 0)
362bde8a8f2STakashi Sakamoto 		*rate = clock.sampling_rate;
363bde8a8f2STakashi Sakamoto 
364bde8a8f2STakashi Sakamoto 	return err;
365bde8a8f2STakashi Sakamoto }
366bde8a8f2STakashi Sakamoto 
snd_efw_command_set_sampling_rate(struct snd_efw * efw,unsigned int rate)367bde8a8f2STakashi Sakamoto int snd_efw_command_set_sampling_rate(struct snd_efw *efw, unsigned int rate)
368bde8a8f2STakashi Sakamoto {
369bde8a8f2STakashi Sakamoto 	return command_set_clock(efw, UINT_MAX, rate);
370bde8a8f2STakashi Sakamoto }
371bde8a8f2STakashi Sakamoto 
372