1 // SPDX-License-Identifier: GPL-2.0-only
2 /******************************************************************************
3 
4     AudioScience HPI driver
5     Copyright (C) 1997-2014  AudioScience Inc. <support@audioscience.com>
6 
7 
8 \file hpicmn.c
9 
10  Common functions used by hpixxxx.c modules
11 
12 (C) Copyright AudioScience Inc. 1998-2003
13 *******************************************************************************/
14 #define SOURCEFILE_NAME "hpicmn.c"
15 
16 #include "hpi_internal.h"
17 #include "hpidebug.h"
18 #include "hpimsginit.h"
19 
20 #include "hpicmn.h"
21 
22 struct hpi_adapters_list {
23 	struct hpios_spinlock list_lock;
24 	struct hpi_adapter_obj adapter[HPI_MAX_ADAPTERS];
25 	u16 gw_num_adapters;
26 };
27 
28 static struct hpi_adapters_list adapters;
29 
30 /**
31  * hpi_validate_response - Given an HPI Message that was sent out and
32  * a response that was received, validate that the response has the
33  * correct fields filled in, i.e ObjectType, Function etc
34  * @phm: message
35  * @phr: response
36  */
hpi_validate_response(struct hpi_message * phm,struct hpi_response * phr)37 u16 hpi_validate_response(struct hpi_message *phm, struct hpi_response *phr)
38 {
39 	if (phr->type != HPI_TYPE_RESPONSE) {
40 		HPI_DEBUG_LOG(ERROR, "header type %d invalid\n", phr->type);
41 		return HPI_ERROR_INVALID_RESPONSE;
42 	}
43 
44 	if (phr->object != phm->object) {
45 		HPI_DEBUG_LOG(ERROR, "header object %d invalid\n",
46 			phr->object);
47 		return HPI_ERROR_INVALID_RESPONSE;
48 	}
49 
50 	if (phr->function != phm->function) {
51 		HPI_DEBUG_LOG(ERROR, "header function %d invalid\n",
52 			phr->function);
53 		return HPI_ERROR_INVALID_RESPONSE;
54 	}
55 
56 	return 0;
57 }
58 
hpi_add_adapter(struct hpi_adapter_obj * pao)59 u16 hpi_add_adapter(struct hpi_adapter_obj *pao)
60 {
61 	u16 retval = 0;
62 	/*HPI_ASSERT(pao->type); */
63 
64 	hpios_alistlock_lock(&adapters);
65 
66 	if (pao->index >= HPI_MAX_ADAPTERS) {
67 		retval = HPI_ERROR_BAD_ADAPTER_NUMBER;
68 		goto unlock;
69 	}
70 
71 	if (adapters.adapter[pao->index].type) {
72 		int a;
73 		for (a = HPI_MAX_ADAPTERS - 1; a >= 0; a--) {
74 			if (!adapters.adapter[a].type) {
75 				HPI_DEBUG_LOG(WARNING,
76 					"ASI%X duplicate index %d moved to %d\n",
77 					pao->type, pao->index, a);
78 				pao->index = a;
79 				break;
80 			}
81 		}
82 		if (a < 0) {
83 			retval = HPI_ERROR_DUPLICATE_ADAPTER_NUMBER;
84 			goto unlock;
85 		}
86 	}
87 	adapters.adapter[pao->index] = *pao;
88 	hpios_dsplock_init(&adapters.adapter[pao->index]);
89 	adapters.gw_num_adapters++;
90 
91 unlock:
92 	hpios_alistlock_unlock(&adapters);
93 	return retval;
94 }
95 
hpi_delete_adapter(struct hpi_adapter_obj * pao)96 void hpi_delete_adapter(struct hpi_adapter_obj *pao)
97 {
98 	if (!pao->type) {
99 		HPI_DEBUG_LOG(ERROR, "removing null adapter?\n");
100 		return;
101 	}
102 
103 	hpios_alistlock_lock(&adapters);
104 	if (adapters.adapter[pao->index].type)
105 		adapters.gw_num_adapters--;
106 	memset(&adapters.adapter[pao->index], 0, sizeof(adapters.adapter[0]));
107 	hpios_alistlock_unlock(&adapters);
108 }
109 
110 /**
111  * hpi_find_adapter - FindAdapter returns a pointer to the struct
112  * hpi_adapter_obj with index wAdapterIndex in an HPI_ADAPTERS_LIST
113  * structure.
114  * @adapter_index: value in [0, HPI_MAX_ADAPTERS[
115  */
hpi_find_adapter(u16 adapter_index)116 struct hpi_adapter_obj *hpi_find_adapter(u16 adapter_index)
117 {
118 	struct hpi_adapter_obj *pao = NULL;
119 
120 	if (adapter_index >= HPI_MAX_ADAPTERS) {
121 		HPI_DEBUG_LOG(VERBOSE, "find_adapter invalid index %d\n",
122 			adapter_index);
123 		return NULL;
124 	}
125 
126 	pao = &adapters.adapter[adapter_index];
127 	if (pao->type != 0) {
128 		/*
129 		   HPI_DEBUG_LOG(VERBOSE, "Found adapter index %d\n",
130 		   wAdapterIndex);
131 		 */
132 		return pao;
133 	} else {
134 		/*
135 		   HPI_DEBUG_LOG(VERBOSE, "No adapter index %d\n",
136 		   wAdapterIndex);
137 		 */
138 		return NULL;
139 	}
140 }
141 
142 /**
143  * wipe_adapter_list - wipe an HPI_ADAPTERS_LIST structure.
144  *
145  */
wipe_adapter_list(void)146 static void wipe_adapter_list(void)
147 {
148 	memset(&adapters, 0, sizeof(adapters));
149 }
150 
subsys_get_adapter(struct hpi_message * phm,struct hpi_response * phr)151 static void subsys_get_adapter(struct hpi_message *phm,
152 	struct hpi_response *phr)
153 {
154 	int count = phm->obj_index;
155 	u16 index = 0;
156 
157 	/* find the nCount'th nonzero adapter in array */
158 	for (index = 0; index < HPI_MAX_ADAPTERS; index++) {
159 		if (adapters.adapter[index].type) {
160 			if (!count)
161 				break;
162 			count--;
163 		}
164 	}
165 
166 	if (index < HPI_MAX_ADAPTERS) {
167 		phr->u.s.adapter_index = adapters.adapter[index].index;
168 		phr->u.s.adapter_type = adapters.adapter[index].type;
169 	} else {
170 		phr->u.s.adapter_index = 0;
171 		phr->u.s.adapter_type = 0;
172 		phr->error = HPI_ERROR_INVALID_OBJ_INDEX;
173 	}
174 }
175 
control_cache_alloc_check(struct hpi_control_cache * pC)176 static unsigned int control_cache_alloc_check(struct hpi_control_cache *pC)
177 {
178 	unsigned int i;
179 	int cached = 0;
180 	if (!pC)
181 		return 0;
182 
183 	if (pC->init)
184 		return pC->init;
185 
186 	if (!pC->p_cache)
187 		return 0;
188 
189 	if (pC->control_count && pC->cache_size_in_bytes) {
190 		char *p_master_cache;
191 		unsigned int byte_count = 0;
192 
193 		p_master_cache = (char *)pC->p_cache;
194 		HPI_DEBUG_LOG(DEBUG, "check %d controls\n",
195 			pC->control_count);
196 		for (i = 0; i < pC->control_count; i++) {
197 			struct hpi_control_cache_info *info =
198 				(struct hpi_control_cache_info *)
199 				&p_master_cache[byte_count];
200 			u16 control_index = info->control_index;
201 
202 			if (control_index >= pC->control_count) {
203 				HPI_DEBUG_LOG(INFO,
204 					"adap %d control index %d out of range, cache not ready?\n",
205 					pC->adap_idx, control_index);
206 				return 0;
207 			}
208 
209 			if (!info->size_in32bit_words) {
210 				if (!i) {
211 					HPI_DEBUG_LOG(INFO,
212 						"adap %d cache not ready?\n",
213 						pC->adap_idx);
214 					return 0;
215 				}
216 				/* The cache is invalid.
217 				 * Minimum valid entry size is
218 				 * sizeof(struct hpi_control_cache_info)
219 				 */
220 				HPI_DEBUG_LOG(ERROR,
221 					"adap %d zero size cache entry %d\n",
222 					pC->adap_idx, i);
223 				break;
224 			}
225 
226 			if (info->control_type) {
227 				pC->p_info[control_index] = info;
228 				cached++;
229 			} else {	/* dummy cache entry */
230 				pC->p_info[control_index] = NULL;
231 			}
232 
233 			byte_count += info->size_in32bit_words * 4;
234 
235 			HPI_DEBUG_LOG(VERBOSE,
236 				"cached %d, pinfo %p index %d type %d size %d\n",
237 				cached, pC->p_info[info->control_index],
238 				info->control_index, info->control_type,
239 				info->size_in32bit_words);
240 
241 			/* quit loop early if whole cache has been scanned.
242 			 * dwControlCount is the maximum possible entries
243 			 * but some may be absent from the cache
244 			 */
245 			if (byte_count >= pC->cache_size_in_bytes)
246 				break;
247 			/* have seen last control index */
248 			if (info->control_index == pC->control_count - 1)
249 				break;
250 		}
251 
252 		if (byte_count != pC->cache_size_in_bytes)
253 			HPI_DEBUG_LOG(WARNING,
254 				"adap %d bytecount %d != cache size %d\n",
255 				pC->adap_idx, byte_count,
256 				pC->cache_size_in_bytes);
257 		else
258 			HPI_DEBUG_LOG(DEBUG,
259 				"adap %d cache good, bytecount == cache size = %d\n",
260 				pC->adap_idx, byte_count);
261 
262 		pC->init = (u16)cached;
263 	}
264 	return pC->init;
265 }
266 
267 /** Find a control.
268 */
find_control(u16 control_index,struct hpi_control_cache * p_cache,struct hpi_control_cache_info ** pI)269 static short find_control(u16 control_index,
270 	struct hpi_control_cache *p_cache, struct hpi_control_cache_info **pI)
271 {
272 	if (!control_cache_alloc_check(p_cache)) {
273 		HPI_DEBUG_LOG(VERBOSE,
274 			"control_cache_alloc_check() failed %d\n",
275 			control_index);
276 		return 0;
277 	}
278 
279 	*pI = p_cache->p_info[control_index];
280 	if (!*pI) {
281 		HPI_DEBUG_LOG(VERBOSE, "Uncached Control %d\n",
282 			control_index);
283 		return 0;
284 	} else {
285 		HPI_DEBUG_LOG(VERBOSE, "find_control() type %d\n",
286 			(*pI)->control_type);
287 	}
288 	return 1;
289 }
290 
291 /* allow unified treatment of several string fields within struct */
292 #define HPICMN_PAD_OFS_AND_SIZE(m)  {\
293 	offsetof(struct hpi_control_cache_pad, m), \
294 	sizeof(((struct hpi_control_cache_pad *)(NULL))->m) }
295 
296 struct pad_ofs_size {
297 	unsigned int offset;
298 	unsigned int field_size;
299 };
300 
301 static const struct pad_ofs_size pad_desc[] = {
302 	HPICMN_PAD_OFS_AND_SIZE(c_channel),	/* HPI_PAD_CHANNEL_NAME */
303 	HPICMN_PAD_OFS_AND_SIZE(c_artist),	/* HPI_PAD_ARTIST */
304 	HPICMN_PAD_OFS_AND_SIZE(c_title),	/* HPI_PAD_TITLE */
305 	HPICMN_PAD_OFS_AND_SIZE(c_comment),	/* HPI_PAD_COMMENT */
306 };
307 
308 /** CheckControlCache checks the cache and fills the struct hpi_response
309  * accordingly. It returns one if a cache hit occurred, zero otherwise.
310  */
hpi_check_control_cache_single(struct hpi_control_cache_single * pC,struct hpi_message * phm,struct hpi_response * phr)311 short hpi_check_control_cache_single(struct hpi_control_cache_single *pC,
312 	struct hpi_message *phm, struct hpi_response *phr)
313 {
314 	size_t response_size;
315 	short found = 1;
316 
317 	/* set the default response size */
318 	response_size =
319 		sizeof(struct hpi_response_header) +
320 		sizeof(struct hpi_control_res);
321 
322 	switch (pC->u.i.control_type) {
323 
324 	case HPI_CONTROL_METER:
325 		if (phm->u.c.attribute == HPI_METER_PEAK) {
326 			phr->u.c.an_log_value[0] = pC->u.meter.an_log_peak[0];
327 			phr->u.c.an_log_value[1] = pC->u.meter.an_log_peak[1];
328 		} else if (phm->u.c.attribute == HPI_METER_RMS) {
329 			if (pC->u.meter.an_logRMS[0] ==
330 				HPI_CACHE_INVALID_SHORT) {
331 				phr->error =
332 					HPI_ERROR_INVALID_CONTROL_ATTRIBUTE;
333 				phr->u.c.an_log_value[0] = HPI_METER_MINIMUM;
334 				phr->u.c.an_log_value[1] = HPI_METER_MINIMUM;
335 			} else {
336 				phr->u.c.an_log_value[0] =
337 					pC->u.meter.an_logRMS[0];
338 				phr->u.c.an_log_value[1] =
339 					pC->u.meter.an_logRMS[1];
340 			}
341 		} else
342 			found = 0;
343 		break;
344 	case HPI_CONTROL_VOLUME:
345 		if (phm->u.c.attribute == HPI_VOLUME_GAIN) {
346 			phr->u.c.an_log_value[0] = pC->u.vol.an_log[0];
347 			phr->u.c.an_log_value[1] = pC->u.vol.an_log[1];
348 		} else if (phm->u.c.attribute == HPI_VOLUME_MUTE) {
349 			if (pC->u.vol.flags & HPI_VOLUME_FLAG_HAS_MUTE) {
350 				if (pC->u.vol.flags & HPI_VOLUME_FLAG_MUTED)
351 					phr->u.c.param1 =
352 						HPI_BITMASK_ALL_CHANNELS;
353 				else
354 					phr->u.c.param1 = 0;
355 			} else {
356 				phr->error =
357 					HPI_ERROR_INVALID_CONTROL_ATTRIBUTE;
358 				phr->u.c.param1 = 0;
359 			}
360 		} else {
361 			found = 0;
362 		}
363 		break;
364 	case HPI_CONTROL_MULTIPLEXER:
365 		if (phm->u.c.attribute == HPI_MULTIPLEXER_SOURCE) {
366 			phr->u.c.param1 = pC->u.mux.source_node_type;
367 			phr->u.c.param2 = pC->u.mux.source_node_index;
368 		} else {
369 			found = 0;
370 		}
371 		break;
372 	case HPI_CONTROL_CHANNEL_MODE:
373 		if (phm->u.c.attribute == HPI_CHANNEL_MODE_MODE)
374 			phr->u.c.param1 = pC->u.mode.mode;
375 		else
376 			found = 0;
377 		break;
378 	case HPI_CONTROL_LEVEL:
379 		if (phm->u.c.attribute == HPI_LEVEL_GAIN) {
380 			phr->u.c.an_log_value[0] = pC->u.level.an_log[0];
381 			phr->u.c.an_log_value[1] = pC->u.level.an_log[1];
382 		} else
383 			found = 0;
384 		break;
385 	case HPI_CONTROL_TUNER:
386 		if (phm->u.c.attribute == HPI_TUNER_FREQ)
387 			phr->u.c.param1 = pC->u.tuner.freq_ink_hz;
388 		else if (phm->u.c.attribute == HPI_TUNER_BAND)
389 			phr->u.c.param1 = pC->u.tuner.band;
390 		else if (phm->u.c.attribute == HPI_TUNER_LEVEL_AVG)
391 			if (pC->u.tuner.s_level_avg ==
392 				HPI_CACHE_INVALID_SHORT) {
393 				phr->u.cu.tuner.s_level = 0;
394 				phr->error =
395 					HPI_ERROR_INVALID_CONTROL_ATTRIBUTE;
396 			} else
397 				phr->u.cu.tuner.s_level =
398 					pC->u.tuner.s_level_avg;
399 		else
400 			found = 0;
401 		break;
402 	case HPI_CONTROL_AESEBU_RECEIVER:
403 		if (phm->u.c.attribute == HPI_AESEBURX_ERRORSTATUS)
404 			phr->u.c.param1 = pC->u.aes3rx.error_status;
405 		else if (phm->u.c.attribute == HPI_AESEBURX_FORMAT)
406 			phr->u.c.param1 = pC->u.aes3rx.format;
407 		else
408 			found = 0;
409 		break;
410 	case HPI_CONTROL_AESEBU_TRANSMITTER:
411 		if (phm->u.c.attribute == HPI_AESEBUTX_FORMAT)
412 			phr->u.c.param1 = pC->u.aes3tx.format;
413 		else
414 			found = 0;
415 		break;
416 	case HPI_CONTROL_TONEDETECTOR:
417 		if (phm->u.c.attribute == HPI_TONEDETECTOR_STATE)
418 			phr->u.c.param1 = pC->u.tone.state;
419 		else
420 			found = 0;
421 		break;
422 	case HPI_CONTROL_SILENCEDETECTOR:
423 		if (phm->u.c.attribute == HPI_SILENCEDETECTOR_STATE) {
424 			phr->u.c.param1 = pC->u.silence.state;
425 		} else
426 			found = 0;
427 		break;
428 	case HPI_CONTROL_MICROPHONE:
429 		if (phm->u.c.attribute == HPI_MICROPHONE_PHANTOM_POWER)
430 			phr->u.c.param1 = pC->u.microphone.phantom_state;
431 		else
432 			found = 0;
433 		break;
434 	case HPI_CONTROL_SAMPLECLOCK:
435 		if (phm->u.c.attribute == HPI_SAMPLECLOCK_SOURCE)
436 			phr->u.c.param1 = pC->u.clk.source;
437 		else if (phm->u.c.attribute == HPI_SAMPLECLOCK_SOURCE_INDEX) {
438 			if (pC->u.clk.source_index ==
439 				HPI_CACHE_INVALID_UINT16) {
440 				phr->u.c.param1 = 0;
441 				phr->error =
442 					HPI_ERROR_INVALID_CONTROL_ATTRIBUTE;
443 			} else
444 				phr->u.c.param1 = pC->u.clk.source_index;
445 		} else if (phm->u.c.attribute == HPI_SAMPLECLOCK_SAMPLERATE)
446 			phr->u.c.param1 = pC->u.clk.sample_rate;
447 		else
448 			found = 0;
449 		break;
450 	case HPI_CONTROL_PAD:{
451 			struct hpi_control_cache_pad *p_pad;
452 			p_pad = (struct hpi_control_cache_pad *)pC;
453 
454 			if (!(p_pad->field_valid_flags & (1 <<
455 						HPI_CTL_ATTR_INDEX(phm->u.c.
456 							attribute)))) {
457 				phr->error =
458 					HPI_ERROR_INVALID_CONTROL_ATTRIBUTE;
459 				break;
460 			}
461 
462 			if (phm->u.c.attribute == HPI_PAD_PROGRAM_ID)
463 				phr->u.c.param1 = p_pad->pI;
464 			else if (phm->u.c.attribute == HPI_PAD_PROGRAM_TYPE)
465 				phr->u.c.param1 = p_pad->pTY;
466 			else {
467 				unsigned int index =
468 					HPI_CTL_ATTR_INDEX(phm->u.c.
469 					attribute) - 1;
470 				unsigned int offset = phm->u.c.param1;
471 				unsigned int pad_string_len, field_size;
472 				char *pad_string;
473 				unsigned int tocopy;
474 
475 				if (index > ARRAY_SIZE(pad_desc) - 1) {
476 					phr->error =
477 						HPI_ERROR_INVALID_CONTROL_ATTRIBUTE;
478 					break;
479 				}
480 
481 				pad_string =
482 					((char *)p_pad) +
483 					pad_desc[index].offset;
484 				field_size = pad_desc[index].field_size;
485 				/* Ensure null terminator */
486 				pad_string[field_size - 1] = 0;
487 
488 				pad_string_len = strlen(pad_string) + 1;
489 
490 				if (offset > pad_string_len) {
491 					phr->error =
492 						HPI_ERROR_INVALID_CONTROL_VALUE;
493 					break;
494 				}
495 
496 				tocopy = pad_string_len - offset;
497 				if (tocopy > sizeof(phr->u.cu.chars8.sz_data))
498 					tocopy = sizeof(phr->u.cu.chars8.
499 						sz_data);
500 
501 				memcpy(phr->u.cu.chars8.sz_data,
502 					&pad_string[offset], tocopy);
503 
504 				phr->u.cu.chars8.remaining_chars =
505 					pad_string_len - offset - tocopy;
506 			}
507 		}
508 		break;
509 	default:
510 		found = 0;
511 		break;
512 	}
513 
514 	HPI_DEBUG_LOG(VERBOSE, "%s Adap %d, Ctl %d, Type %d, Attr %d\n",
515 		found ? "Cached" : "Uncached", phm->adapter_index,
516 		pC->u.i.control_index, pC->u.i.control_type,
517 		phm->u.c.attribute);
518 
519 	if (found) {
520 		phr->size = (u16)response_size;
521 		phr->type = HPI_TYPE_RESPONSE;
522 		phr->object = phm->object;
523 		phr->function = phm->function;
524 	}
525 
526 	return found;
527 }
528 
hpi_check_control_cache(struct hpi_control_cache * p_cache,struct hpi_message * phm,struct hpi_response * phr)529 short hpi_check_control_cache(struct hpi_control_cache *p_cache,
530 	struct hpi_message *phm, struct hpi_response *phr)
531 {
532 	struct hpi_control_cache_info *pI;
533 
534 	if (!find_control(phm->obj_index, p_cache, &pI)) {
535 		HPI_DEBUG_LOG(VERBOSE,
536 			"HPICMN find_control() failed for adap %d\n",
537 			phm->adapter_index);
538 		return 0;
539 	}
540 
541 	phr->error = 0;
542 	phr->specific_error = 0;
543 	phr->version = 0;
544 
545 	return hpi_check_control_cache_single((struct hpi_control_cache_single
546 			*)pI, phm, phr);
547 }
548 
549 /** Updates the cache with Set values.
550 
551 Only update if no error.
552 Volume and Level return the limited values in the response, so use these
553 Multiplexer does so use sent values
554 */
hpi_cmn_control_cache_sync_to_msg_single(struct hpi_control_cache_single * pC,struct hpi_message * phm,struct hpi_response * phr)555 void hpi_cmn_control_cache_sync_to_msg_single(struct hpi_control_cache_single
556 	*pC, struct hpi_message *phm, struct hpi_response *phr)
557 {
558 	switch (pC->u.i.control_type) {
559 	case HPI_CONTROL_VOLUME:
560 		if (phm->u.c.attribute == HPI_VOLUME_GAIN) {
561 			pC->u.vol.an_log[0] = phr->u.c.an_log_value[0];
562 			pC->u.vol.an_log[1] = phr->u.c.an_log_value[1];
563 		} else if (phm->u.c.attribute == HPI_VOLUME_MUTE) {
564 			if (phm->u.c.param1)
565 				pC->u.vol.flags |= HPI_VOLUME_FLAG_MUTED;
566 			else
567 				pC->u.vol.flags &= ~HPI_VOLUME_FLAG_MUTED;
568 		}
569 		break;
570 	case HPI_CONTROL_MULTIPLEXER:
571 		/* mux does not return its setting on Set command. */
572 		if (phm->u.c.attribute == HPI_MULTIPLEXER_SOURCE) {
573 			pC->u.mux.source_node_type = (u16)phm->u.c.param1;
574 			pC->u.mux.source_node_index = (u16)phm->u.c.param2;
575 		}
576 		break;
577 	case HPI_CONTROL_CHANNEL_MODE:
578 		/* mode does not return its setting on Set command. */
579 		if (phm->u.c.attribute == HPI_CHANNEL_MODE_MODE)
580 			pC->u.mode.mode = (u16)phm->u.c.param1;
581 		break;
582 	case HPI_CONTROL_LEVEL:
583 		if (phm->u.c.attribute == HPI_LEVEL_GAIN) {
584 			pC->u.vol.an_log[0] = phr->u.c.an_log_value[0];
585 			pC->u.vol.an_log[1] = phr->u.c.an_log_value[1];
586 		}
587 		break;
588 	case HPI_CONTROL_MICROPHONE:
589 		if (phm->u.c.attribute == HPI_MICROPHONE_PHANTOM_POWER)
590 			pC->u.microphone.phantom_state = (u16)phm->u.c.param1;
591 		break;
592 	case HPI_CONTROL_AESEBU_TRANSMITTER:
593 		if (phm->u.c.attribute == HPI_AESEBUTX_FORMAT)
594 			pC->u.aes3tx.format = phm->u.c.param1;
595 		break;
596 	case HPI_CONTROL_AESEBU_RECEIVER:
597 		if (phm->u.c.attribute == HPI_AESEBURX_FORMAT)
598 			pC->u.aes3rx.format = phm->u.c.param1;
599 		break;
600 	case HPI_CONTROL_SAMPLECLOCK:
601 		if (phm->u.c.attribute == HPI_SAMPLECLOCK_SOURCE)
602 			pC->u.clk.source = (u16)phm->u.c.param1;
603 		else if (phm->u.c.attribute == HPI_SAMPLECLOCK_SOURCE_INDEX)
604 			pC->u.clk.source_index = (u16)phm->u.c.param1;
605 		else if (phm->u.c.attribute == HPI_SAMPLECLOCK_SAMPLERATE)
606 			pC->u.clk.sample_rate = phm->u.c.param1;
607 		break;
608 	default:
609 		break;
610 	}
611 }
612 
hpi_cmn_control_cache_sync_to_msg(struct hpi_control_cache * p_cache,struct hpi_message * phm,struct hpi_response * phr)613 void hpi_cmn_control_cache_sync_to_msg(struct hpi_control_cache *p_cache,
614 	struct hpi_message *phm, struct hpi_response *phr)
615 {
616 	struct hpi_control_cache_single *pC;
617 	struct hpi_control_cache_info *pI;
618 
619 	if (phr->error)
620 		return;
621 
622 	if (!find_control(phm->obj_index, p_cache, &pI)) {
623 		HPI_DEBUG_LOG(VERBOSE,
624 			"HPICMN find_control() failed for adap %d\n",
625 			phm->adapter_index);
626 		return;
627 	}
628 
629 	/* pC is the default cached control strucure.
630 	   May be cast to something else in the following switch statement.
631 	 */
632 	pC = (struct hpi_control_cache_single *)pI;
633 
634 	hpi_cmn_control_cache_sync_to_msg_single(pC, phm, phr);
635 }
636 
637 /** Allocate control cache.
638 
639 \return Cache pointer, or NULL if allocation fails.
640 */
hpi_alloc_control_cache(const u32 control_count,const u32 size_in_bytes,u8 * p_dsp_control_buffer)641 struct hpi_control_cache *hpi_alloc_control_cache(const u32 control_count,
642 	const u32 size_in_bytes, u8 *p_dsp_control_buffer)
643 {
644 	struct hpi_control_cache *p_cache =
645 		kmalloc(sizeof(*p_cache), GFP_KERNEL);
646 	if (!p_cache)
647 		return NULL;
648 
649 	p_cache->p_info =
650 		kcalloc(control_count, sizeof(*p_cache->p_info), GFP_KERNEL);
651 	if (!p_cache->p_info) {
652 		kfree(p_cache);
653 		return NULL;
654 	}
655 
656 	p_cache->cache_size_in_bytes = size_in_bytes;
657 	p_cache->control_count = control_count;
658 	p_cache->p_cache = p_dsp_control_buffer;
659 	p_cache->init = 0;
660 	return p_cache;
661 }
662 
hpi_free_control_cache(struct hpi_control_cache * p_cache)663 void hpi_free_control_cache(struct hpi_control_cache *p_cache)
664 {
665 	if (p_cache) {
666 		kfree(p_cache->p_info);
667 		kfree(p_cache);
668 	}
669 }
670 
subsys_message(struct hpi_message * phm,struct hpi_response * phr)671 static void subsys_message(struct hpi_message *phm, struct hpi_response *phr)
672 {
673 	hpi_init_response(phr, HPI_OBJ_SUBSYSTEM, phm->function, 0);
674 
675 	switch (phm->function) {
676 	case HPI_SUBSYS_OPEN:
677 	case HPI_SUBSYS_CLOSE:
678 	case HPI_SUBSYS_DRIVER_UNLOAD:
679 		break;
680 	case HPI_SUBSYS_DRIVER_LOAD:
681 		wipe_adapter_list();
682 		hpios_alistlock_init(&adapters);
683 		break;
684 	case HPI_SUBSYS_GET_ADAPTER:
685 		subsys_get_adapter(phm, phr);
686 		break;
687 	case HPI_SUBSYS_GET_NUM_ADAPTERS:
688 		phr->u.s.num_adapters = adapters.gw_num_adapters;
689 		break;
690 	case HPI_SUBSYS_CREATE_ADAPTER:
691 		break;
692 	default:
693 		phr->error = HPI_ERROR_INVALID_FUNC;
694 		break;
695 	}
696 }
697 
HPI_COMMON(struct hpi_message * phm,struct hpi_response * phr)698 void HPI_COMMON(struct hpi_message *phm, struct hpi_response *phr)
699 {
700 	switch (phm->type) {
701 	case HPI_TYPE_REQUEST:
702 		switch (phm->object) {
703 		case HPI_OBJ_SUBSYSTEM:
704 			subsys_message(phm, phr);
705 			break;
706 		}
707 		break;
708 
709 	default:
710 		phr->error = HPI_ERROR_INVALID_TYPE;
711 		break;
712 	}
713 }
714