~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/sound/pci/asihpi/hpimsgx.c

Version: ~ [ linux-6.11.5 ] ~ [ linux-6.10.14 ] ~ [ linux-6.9.12 ] ~ [ linux-6.8.12 ] ~ [ linux-6.7.12 ] ~ [ linux-6.6.58 ] ~ [ linux-6.5.13 ] ~ [ linux-6.4.16 ] ~ [ linux-6.3.13 ] ~ [ linux-6.2.16 ] ~ [ linux-6.1.114 ] ~ [ linux-6.0.19 ] ~ [ linux-5.19.17 ] ~ [ linux-5.18.19 ] ~ [ linux-5.17.15 ] ~ [ linux-5.16.20 ] ~ [ linux-5.15.169 ] ~ [ linux-5.14.21 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.228 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.284 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.322 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.336 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.337 ] ~ [ linux-4.4.302 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.9 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  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 Extended Message Function With Response Caching
  9 
 10 (C) Copyright AudioScience Inc. 2002
 11 *****************************************************************************/
 12 #define SOURCEFILE_NAME "hpimsgx.c"
 13 #include "hpi_internal.h"
 14 #include "hpi_version.h"
 15 #include "hpimsginit.h"
 16 #include "hpicmn.h"
 17 #include "hpimsgx.h"
 18 #include "hpidebug.h"
 19 
 20 static const struct pci_device_id asihpi_pci_tbl[] = {
 21 #include "hpipcida.h"
 22 };
 23 
 24 static struct hpios_spinlock msgx_lock;
 25 
 26 static hpi_handler_func *hpi_entry_points[HPI_MAX_ADAPTERS];
 27 static int logging_enabled = 1;
 28 
 29 static hpi_handler_func *hpi_lookup_entry_point_function(const struct hpi_pci
 30         *pci_info)
 31 {
 32 
 33         int i;
 34 
 35         for (i = 0; asihpi_pci_tbl[i].vendor != 0; i++) {
 36                 if (asihpi_pci_tbl[i].vendor != PCI_ANY_ID
 37                         && asihpi_pci_tbl[i].vendor !=
 38                         pci_info->pci_dev->vendor)
 39                         continue;
 40                 if (asihpi_pci_tbl[i].device != PCI_ANY_ID
 41                         && asihpi_pci_tbl[i].device !=
 42                         pci_info->pci_dev->device)
 43                         continue;
 44                 if (asihpi_pci_tbl[i].subvendor != PCI_ANY_ID
 45                         && asihpi_pci_tbl[i].subvendor !=
 46                         pci_info->pci_dev->subsystem_vendor)
 47                         continue;
 48                 if (asihpi_pci_tbl[i].subdevice != PCI_ANY_ID
 49                         && asihpi_pci_tbl[i].subdevice !=
 50                         pci_info->pci_dev->subsystem_device)
 51                         continue;
 52 
 53                 /* HPI_DEBUG_LOG(DEBUG, " %x,%lx\n", i,
 54                    asihpi_pci_tbl[i].driver_data); */
 55                 return (hpi_handler_func *) asihpi_pci_tbl[i].driver_data;
 56         }
 57 
 58         return NULL;
 59 }
 60 
 61 static inline void hw_entry_point(struct hpi_message *phm,
 62         struct hpi_response *phr)
 63 {
 64         if ((phm->adapter_index < HPI_MAX_ADAPTERS)
 65                 && hpi_entry_points[phm->adapter_index])
 66                 hpi_entry_points[phm->adapter_index] (phm, phr);
 67         else
 68                 hpi_init_response(phr, phm->object, phm->function,
 69                         HPI_ERROR_PROCESSING_MESSAGE);
 70 }
 71 
 72 static void adapter_open(struct hpi_message *phm, struct hpi_response *phr);
 73 static void adapter_close(struct hpi_message *phm, struct hpi_response *phr);
 74 
 75 static void mixer_open(struct hpi_message *phm, struct hpi_response *phr);
 76 static void mixer_close(struct hpi_message *phm, struct hpi_response *phr);
 77 
 78 static void outstream_open(struct hpi_message *phm, struct hpi_response *phr,
 79         void *h_owner);
 80 static void outstream_close(struct hpi_message *phm, struct hpi_response *phr,
 81         void *h_owner);
 82 static void instream_open(struct hpi_message *phm, struct hpi_response *phr,
 83         void *h_owner);
 84 static void instream_close(struct hpi_message *phm, struct hpi_response *phr,
 85         void *h_owner);
 86 
 87 static void HPIMSGX__reset(u16 adapter_index);
 88 
 89 static u16 HPIMSGX__init(struct hpi_message *phm, struct hpi_response *phr);
 90 static void HPIMSGX__cleanup(u16 adapter_index, void *h_owner);
 91 
 92 #ifndef DISABLE_PRAGMA_PACK1
 93 #pragma pack(push, 1)
 94 #endif
 95 
 96 struct hpi_adapter_response {
 97         struct hpi_response_header h;
 98         struct hpi_adapter_res a;
 99 };
100 
101 struct hpi_mixer_response {
102         struct hpi_response_header h;
103         struct hpi_mixer_res m;
104 };
105 
106 struct hpi_stream_response {
107         struct hpi_response_header h;
108         struct hpi_stream_res d;
109 };
110 
111 struct adapter_info {
112         u16 type;
113         u16 num_instreams;
114         u16 num_outstreams;
115 };
116 
117 struct asi_open_state {
118         int open_flag;
119         void *h_owner;
120 };
121 
122 #ifndef DISABLE_PRAGMA_PACK1
123 #pragma pack(pop)
124 #endif
125 
126 /* Globals */
127 static struct hpi_adapter_response rESP_HPI_ADAPTER_OPEN[HPI_MAX_ADAPTERS];
128 
129 static struct hpi_stream_response
130         rESP_HPI_OSTREAM_OPEN[HPI_MAX_ADAPTERS][HPI_MAX_STREAMS];
131 
132 static struct hpi_stream_response
133         rESP_HPI_ISTREAM_OPEN[HPI_MAX_ADAPTERS][HPI_MAX_STREAMS];
134 
135 static struct hpi_mixer_response rESP_HPI_MIXER_OPEN[HPI_MAX_ADAPTERS];
136 
137 static struct adapter_info aDAPTER_INFO[HPI_MAX_ADAPTERS];
138 
139 /* use these to keep track of opens from user mode apps/DLLs */
140 static struct asi_open_state
141         outstream_user_open[HPI_MAX_ADAPTERS][HPI_MAX_STREAMS];
142 
143 static struct asi_open_state
144         instream_user_open[HPI_MAX_ADAPTERS][HPI_MAX_STREAMS];
145 
146 static void subsys_message(struct hpi_message *phm, struct hpi_response *phr,
147         void *h_owner)
148 {
149         if (phm->adapter_index != HPI_ADAPTER_INDEX_INVALID)
150                 HPI_DEBUG_LOG(WARNING,
151                         "suspicious adapter index %d in subsys message 0x%x.\n",
152                         phm->adapter_index, phm->function);
153 
154         switch (phm->function) {
155         case HPI_SUBSYS_GET_VERSION:
156                 hpi_init_response(phr, HPI_OBJ_SUBSYSTEM,
157                         HPI_SUBSYS_GET_VERSION, 0);
158                 phr->u.s.version = HPI_VER >> 8;        /* return major.minor */
159                 phr->u.s.data = HPI_VER;        /* return major.minor.release */
160                 break;
161         case HPI_SUBSYS_OPEN:
162                 /*do not propagate the message down the chain */
163                 hpi_init_response(phr, HPI_OBJ_SUBSYSTEM, HPI_SUBSYS_OPEN, 0);
164                 break;
165         case HPI_SUBSYS_CLOSE:
166                 /*do not propagate the message down the chain */
167                 hpi_init_response(phr, HPI_OBJ_SUBSYSTEM, HPI_SUBSYS_CLOSE,
168                         0);
169                 HPIMSGX__cleanup(HPIMSGX_ALLADAPTERS, h_owner);
170                 break;
171         case HPI_SUBSYS_DRIVER_LOAD:
172                 /* Initialize this module's internal state */
173                 hpios_msgxlock_init(&msgx_lock);
174                 memset(&hpi_entry_points, 0, sizeof(hpi_entry_points));
175                 /* Init subsys_findadapters response to no-adapters */
176                 HPIMSGX__reset(HPIMSGX_ALLADAPTERS);
177                 hpi_init_response(phr, HPI_OBJ_SUBSYSTEM,
178                         HPI_SUBSYS_DRIVER_LOAD, 0);
179                 /* individual HPIs dont implement driver load */
180                 HPI_COMMON(phm, phr);
181                 break;
182         case HPI_SUBSYS_DRIVER_UNLOAD:
183                 HPI_COMMON(phm, phr);
184                 HPIMSGX__cleanup(HPIMSGX_ALLADAPTERS, h_owner);
185                 hpi_init_response(phr, HPI_OBJ_SUBSYSTEM,
186                         HPI_SUBSYS_DRIVER_UNLOAD, 0);
187                 return;
188 
189         case HPI_SUBSYS_GET_NUM_ADAPTERS:
190         case HPI_SUBSYS_GET_ADAPTER:
191                 HPI_COMMON(phm, phr);
192                 break;
193 
194         case HPI_SUBSYS_CREATE_ADAPTER:
195                 HPIMSGX__init(phm, phr);
196                 break;
197 
198         default:
199                 /* Must explicitly handle every subsys message in this switch */
200                 hpi_init_response(phr, HPI_OBJ_SUBSYSTEM, phm->function,
201                         HPI_ERROR_INVALID_FUNC);
202                 break;
203         }
204 }
205 
206 static void adapter_message(struct hpi_message *phm, struct hpi_response *phr,
207         void *h_owner)
208 {
209         switch (phm->function) {
210         case HPI_ADAPTER_OPEN:
211                 adapter_open(phm, phr);
212                 break;
213         case HPI_ADAPTER_CLOSE:
214                 adapter_close(phm, phr);
215                 break;
216         case HPI_ADAPTER_DELETE:
217                 HPIMSGX__cleanup(phm->adapter_index, h_owner);
218                 {
219                         struct hpi_message hm;
220                         struct hpi_response hr;
221                         hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER,
222                                 HPI_ADAPTER_CLOSE);
223                         hm.adapter_index = phm->adapter_index;
224                         hw_entry_point(&hm, &hr);
225                 }
226                 hw_entry_point(phm, phr);
227                 break;
228 
229         default:
230                 hw_entry_point(phm, phr);
231                 break;
232         }
233 }
234 
235 static void mixer_message(struct hpi_message *phm, struct hpi_response *phr)
236 {
237         switch (phm->function) {
238         case HPI_MIXER_OPEN:
239                 mixer_open(phm, phr);
240                 break;
241         case HPI_MIXER_CLOSE:
242                 mixer_close(phm, phr);
243                 break;
244         default:
245                 hw_entry_point(phm, phr);
246                 break;
247         }
248 }
249 
250 static void outstream_message(struct hpi_message *phm,
251         struct hpi_response *phr, void *h_owner)
252 {
253         if (phm->obj_index >= aDAPTER_INFO[phm->adapter_index].num_outstreams) {
254                 hpi_init_response(phr, HPI_OBJ_OSTREAM, phm->function,
255                         HPI_ERROR_INVALID_OBJ_INDEX);
256                 return;
257         }
258 
259         switch (phm->function) {
260         case HPI_OSTREAM_OPEN:
261                 outstream_open(phm, phr, h_owner);
262                 break;
263         case HPI_OSTREAM_CLOSE:
264                 outstream_close(phm, phr, h_owner);
265                 break;
266         default:
267                 hw_entry_point(phm, phr);
268                 break;
269         }
270 }
271 
272 static void instream_message(struct hpi_message *phm,
273         struct hpi_response *phr, void *h_owner)
274 {
275         if (phm->obj_index >= aDAPTER_INFO[phm->adapter_index].num_instreams) {
276                 hpi_init_response(phr, HPI_OBJ_ISTREAM, phm->function,
277                         HPI_ERROR_INVALID_OBJ_INDEX);
278                 return;
279         }
280 
281         switch (phm->function) {
282         case HPI_ISTREAM_OPEN:
283                 instream_open(phm, phr, h_owner);
284                 break;
285         case HPI_ISTREAM_CLOSE:
286                 instream_close(phm, phr, h_owner);
287                 break;
288         default:
289                 hw_entry_point(phm, phr);
290                 break;
291         }
292 }
293 
294 /* NOTE: HPI_Message() must be defined in the driver as a wrapper for
295  * HPI_MessageEx so that functions in hpifunc.c compile.
296  */
297 void hpi_send_recv_ex(struct hpi_message *phm, struct hpi_response *phr,
298         void *h_owner)
299 {
300 
301         if (logging_enabled)
302                 HPI_DEBUG_MESSAGE(DEBUG, phm);
303 
304         if (phm->type != HPI_TYPE_REQUEST) {
305                 hpi_init_response(phr, phm->object, phm->function,
306                         HPI_ERROR_INVALID_TYPE);
307                 return;
308         }
309 
310         if (phm->adapter_index >= HPI_MAX_ADAPTERS
311                 && phm->adapter_index != HPIMSGX_ALLADAPTERS) {
312                 hpi_init_response(phr, phm->object, phm->function,
313                         HPI_ERROR_BAD_ADAPTER_NUMBER);
314                 return;
315         }
316 
317         switch (phm->object) {
318         case HPI_OBJ_SUBSYSTEM:
319                 subsys_message(phm, phr, h_owner);
320                 break;
321 
322         case HPI_OBJ_ADAPTER:
323                 adapter_message(phm, phr, h_owner);
324                 break;
325 
326         case HPI_OBJ_MIXER:
327                 mixer_message(phm, phr);
328                 break;
329 
330         case HPI_OBJ_OSTREAM:
331                 outstream_message(phm, phr, h_owner);
332                 break;
333 
334         case HPI_OBJ_ISTREAM:
335                 instream_message(phm, phr, h_owner);
336                 break;
337 
338         default:
339                 hw_entry_point(phm, phr);
340                 break;
341         }
342 
343         if (logging_enabled)
344                 HPI_DEBUG_RESPONSE(phr);
345 
346         if (phr->error >= HPI_ERROR_DSP_COMMUNICATION) {
347                 hpi_debug_level_set(HPI_DEBUG_LEVEL_ERROR);
348                 logging_enabled = 0;
349         }
350 }
351 
352 static void adapter_open(struct hpi_message *phm, struct hpi_response *phr)
353 {
354         HPI_DEBUG_LOG(VERBOSE, "adapter_open\n");
355         memcpy(phr, &rESP_HPI_ADAPTER_OPEN[phm->adapter_index],
356                 sizeof(rESP_HPI_ADAPTER_OPEN[0]));
357 }
358 
359 static void adapter_close(struct hpi_message *phm, struct hpi_response *phr)
360 {
361         HPI_DEBUG_LOG(VERBOSE, "adapter_close\n");
362         hpi_init_response(phr, HPI_OBJ_ADAPTER, HPI_ADAPTER_CLOSE, 0);
363 }
364 
365 static void mixer_open(struct hpi_message *phm, struct hpi_response *phr)
366 {
367         memcpy(phr, &rESP_HPI_MIXER_OPEN[phm->adapter_index],
368                 sizeof(rESP_HPI_MIXER_OPEN[0]));
369 }
370 
371 static void mixer_close(struct hpi_message *phm, struct hpi_response *phr)
372 {
373         hpi_init_response(phr, HPI_OBJ_MIXER, HPI_MIXER_CLOSE, 0);
374 }
375 
376 static void instream_open(struct hpi_message *phm, struct hpi_response *phr,
377         void *h_owner)
378 {
379 
380         struct hpi_message hm;
381         struct hpi_response hr;
382 
383         hpi_init_response(phr, HPI_OBJ_ISTREAM, HPI_ISTREAM_OPEN, 0);
384 
385         hpios_msgxlock_lock(&msgx_lock);
386 
387         if (instream_user_open[phm->adapter_index][phm->obj_index].open_flag)
388                 phr->error = HPI_ERROR_OBJ_ALREADY_OPEN;
389         else if (rESP_HPI_ISTREAM_OPEN[phm->adapter_index]
390                 [phm->obj_index].h.error)
391                 memcpy(phr,
392                         &rESP_HPI_ISTREAM_OPEN[phm->adapter_index][phm->
393                                 obj_index],
394                         sizeof(rESP_HPI_ISTREAM_OPEN[0][0]));
395         else {
396                 instream_user_open[phm->adapter_index][phm->
397                         obj_index].open_flag = 1;
398                 hpios_msgxlock_unlock(&msgx_lock);
399 
400                 /* issue a reset */
401                 hpi_init_message_response(&hm, &hr, HPI_OBJ_ISTREAM,
402                         HPI_ISTREAM_RESET);
403                 hm.adapter_index = phm->adapter_index;
404                 hm.obj_index = phm->obj_index;
405                 hw_entry_point(&hm, &hr);
406 
407                 hpios_msgxlock_lock(&msgx_lock);
408                 if (hr.error) {
409                         instream_user_open[phm->adapter_index][phm->
410                                 obj_index].open_flag = 0;
411                         phr->error = hr.error;
412                 } else {
413                         instream_user_open[phm->adapter_index][phm->
414                                 obj_index].open_flag = 1;
415                         instream_user_open[phm->adapter_index][phm->
416                                 obj_index].h_owner = h_owner;
417                         memcpy(phr,
418                                 &rESP_HPI_ISTREAM_OPEN[phm->adapter_index]
419                                 [phm->obj_index],
420                                 sizeof(rESP_HPI_ISTREAM_OPEN[0][0]));
421                 }
422         }
423         hpios_msgxlock_unlock(&msgx_lock);
424 }
425 
426 static void instream_close(struct hpi_message *phm, struct hpi_response *phr,
427         void *h_owner)
428 {
429 
430         struct hpi_message hm;
431         struct hpi_response hr;
432 
433         hpi_init_response(phr, HPI_OBJ_ISTREAM, HPI_ISTREAM_CLOSE, 0);
434 
435         hpios_msgxlock_lock(&msgx_lock);
436         if (h_owner ==
437                 instream_user_open[phm->adapter_index][phm->
438                         obj_index].h_owner) {
439                 /* HPI_DEBUG_LOG(INFO,"closing adapter %d "
440                    "instream %d owned by %p\n",
441                    phm->wAdapterIndex, phm->wObjIndex, hOwner); */
442                 instream_user_open[phm->adapter_index][phm->
443                         obj_index].h_owner = NULL;
444                 hpios_msgxlock_unlock(&msgx_lock);
445                 /* issue a reset */
446                 hpi_init_message_response(&hm, &hr, HPI_OBJ_ISTREAM,
447                         HPI_ISTREAM_RESET);
448                 hm.adapter_index = phm->adapter_index;
449                 hm.obj_index = phm->obj_index;
450                 hw_entry_point(&hm, &hr);
451                 hpios_msgxlock_lock(&msgx_lock);
452                 if (hr.error) {
453                         instream_user_open[phm->adapter_index][phm->
454                                 obj_index].h_owner = h_owner;
455                         phr->error = hr.error;
456                 } else {
457                         instream_user_open[phm->adapter_index][phm->
458                                 obj_index].open_flag = 0;
459                         instream_user_open[phm->adapter_index][phm->
460                                 obj_index].h_owner = NULL;
461                 }
462         } else {
463                 HPI_DEBUG_LOG(WARNING,
464                         "%p trying to close %d instream %d owned by %p\n",
465                         h_owner, phm->adapter_index, phm->obj_index,
466                         instream_user_open[phm->adapter_index][phm->
467                                 obj_index].h_owner);
468                 phr->error = HPI_ERROR_OBJ_NOT_OPEN;
469         }
470         hpios_msgxlock_unlock(&msgx_lock);
471 }
472 
473 static void outstream_open(struct hpi_message *phm, struct hpi_response *phr,
474         void *h_owner)
475 {
476 
477         struct hpi_message hm;
478         struct hpi_response hr;
479 
480         hpi_init_response(phr, HPI_OBJ_OSTREAM, HPI_OSTREAM_OPEN, 0);
481 
482         hpios_msgxlock_lock(&msgx_lock);
483 
484         if (outstream_user_open[phm->adapter_index][phm->obj_index].open_flag)
485                 phr->error = HPI_ERROR_OBJ_ALREADY_OPEN;
486         else if (rESP_HPI_OSTREAM_OPEN[phm->adapter_index]
487                 [phm->obj_index].h.error)
488                 memcpy(phr,
489                         &rESP_HPI_OSTREAM_OPEN[phm->adapter_index][phm->
490                                 obj_index],
491                         sizeof(rESP_HPI_OSTREAM_OPEN[0][0]));
492         else {
493                 outstream_user_open[phm->adapter_index][phm->
494                         obj_index].open_flag = 1;
495                 hpios_msgxlock_unlock(&msgx_lock);
496 
497                 /* issue a reset */
498                 hpi_init_message_response(&hm, &hr, HPI_OBJ_OSTREAM,
499                         HPI_OSTREAM_RESET);
500                 hm.adapter_index = phm->adapter_index;
501                 hm.obj_index = phm->obj_index;
502                 hw_entry_point(&hm, &hr);
503 
504                 hpios_msgxlock_lock(&msgx_lock);
505                 if (hr.error) {
506                         outstream_user_open[phm->adapter_index][phm->
507                                 obj_index].open_flag = 0;
508                         phr->error = hr.error;
509                 } else {
510                         outstream_user_open[phm->adapter_index][phm->
511                                 obj_index].open_flag = 1;
512                         outstream_user_open[phm->adapter_index][phm->
513                                 obj_index].h_owner = h_owner;
514                         memcpy(phr,
515                                 &rESP_HPI_OSTREAM_OPEN[phm->adapter_index]
516                                 [phm->obj_index],
517                                 sizeof(rESP_HPI_OSTREAM_OPEN[0][0]));
518                 }
519         }
520         hpios_msgxlock_unlock(&msgx_lock);
521 }
522 
523 static void outstream_close(struct hpi_message *phm, struct hpi_response *phr,
524         void *h_owner)
525 {
526 
527         struct hpi_message hm;
528         struct hpi_response hr;
529 
530         hpi_init_response(phr, HPI_OBJ_OSTREAM, HPI_OSTREAM_CLOSE, 0);
531 
532         hpios_msgxlock_lock(&msgx_lock);
533 
534         if (h_owner ==
535                 outstream_user_open[phm->adapter_index][phm->
536                         obj_index].h_owner) {
537                 /* HPI_DEBUG_LOG(INFO,"closing adapter %d "
538                    "outstream %d owned by %p\n",
539                    phm->wAdapterIndex, phm->wObjIndex, hOwner); */
540                 outstream_user_open[phm->adapter_index][phm->
541                         obj_index].h_owner = NULL;
542                 hpios_msgxlock_unlock(&msgx_lock);
543                 /* issue a reset */
544                 hpi_init_message_response(&hm, &hr, HPI_OBJ_OSTREAM,
545                         HPI_OSTREAM_RESET);
546                 hm.adapter_index = phm->adapter_index;
547                 hm.obj_index = phm->obj_index;
548                 hw_entry_point(&hm, &hr);
549                 hpios_msgxlock_lock(&msgx_lock);
550                 if (hr.error) {
551                         outstream_user_open[phm->adapter_index][phm->
552                                 obj_index].h_owner = h_owner;
553                         phr->error = hr.error;
554                 } else {
555                         outstream_user_open[phm->adapter_index][phm->
556                                 obj_index].open_flag = 0;
557                         outstream_user_open[phm->adapter_index][phm->
558                                 obj_index].h_owner = NULL;
559                 }
560         } else {
561                 HPI_DEBUG_LOG(WARNING,
562                         "%p trying to close %d outstream %d owned by %p\n",
563                         h_owner, phm->adapter_index, phm->obj_index,
564                         outstream_user_open[phm->adapter_index][phm->
565                                 obj_index].h_owner);
566                 phr->error = HPI_ERROR_OBJ_NOT_OPEN;
567         }
568         hpios_msgxlock_unlock(&msgx_lock);
569 }
570 
571 static u16 adapter_prepare(u16 adapter)
572 {
573         struct hpi_message hm;
574         struct hpi_response hr;
575 
576         /* Open the adapter and streams */
577         u16 i;
578 
579         /* call to HPI_ADAPTER_OPEN */
580         hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER,
581                 HPI_ADAPTER_OPEN);
582         hm.adapter_index = adapter;
583         hw_entry_point(&hm, &hr);
584         memcpy(&rESP_HPI_ADAPTER_OPEN[adapter], &hr,
585                 sizeof(rESP_HPI_ADAPTER_OPEN[0]));
586         if (hr.error)
587                 return hr.error;
588 
589         /* call to HPI_ADAPTER_GET_INFO */
590         hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER,
591                 HPI_ADAPTER_GET_INFO);
592         hm.adapter_index = adapter;
593         hw_entry_point(&hm, &hr);
594         if (hr.error)
595                 return hr.error;
596 
597         aDAPTER_INFO[adapter].num_outstreams = hr.u.ax.info.num_outstreams;
598         aDAPTER_INFO[adapter].num_instreams = hr.u.ax.info.num_instreams;
599         aDAPTER_INFO[adapter].type = hr.u.ax.info.adapter_type;
600 
601         /* call to HPI_OSTREAM_OPEN */
602         for (i = 0; i < aDAPTER_INFO[adapter].num_outstreams; i++) {
603                 hpi_init_message_response(&hm, &hr, HPI_OBJ_OSTREAM,
604                         HPI_OSTREAM_OPEN);
605                 hm.adapter_index = adapter;
606                 hm.obj_index = i;
607                 hw_entry_point(&hm, &hr);
608                 memcpy(&rESP_HPI_OSTREAM_OPEN[adapter][i], &hr,
609                         sizeof(rESP_HPI_OSTREAM_OPEN[0][0]));
610                 outstream_user_open[adapter][i].open_flag = 0;
611                 outstream_user_open[adapter][i].h_owner = NULL;
612         }
613 
614         /* call to HPI_ISTREAM_OPEN */
615         for (i = 0; i < aDAPTER_INFO[adapter].num_instreams; i++) {
616                 hpi_init_message_response(&hm, &hr, HPI_OBJ_ISTREAM,
617                         HPI_ISTREAM_OPEN);
618                 hm.adapter_index = adapter;
619                 hm.obj_index = i;
620                 hw_entry_point(&hm, &hr);
621                 memcpy(&rESP_HPI_ISTREAM_OPEN[adapter][i], &hr,
622                         sizeof(rESP_HPI_ISTREAM_OPEN[0][0]));
623                 instream_user_open[adapter][i].open_flag = 0;
624                 instream_user_open[adapter][i].h_owner = NULL;
625         }
626 
627         /* call to HPI_MIXER_OPEN */
628         hpi_init_message_response(&hm, &hr, HPI_OBJ_MIXER, HPI_MIXER_OPEN);
629         hm.adapter_index = adapter;
630         hw_entry_point(&hm, &hr);
631         memcpy(&rESP_HPI_MIXER_OPEN[adapter], &hr,
632                 sizeof(rESP_HPI_MIXER_OPEN[0]));
633 
634         return 0;
635 }
636 
637 static void HPIMSGX__reset(u16 adapter_index)
638 {
639         int i;
640         u16 adapter;
641         struct hpi_response hr;
642 
643         if (adapter_index == HPIMSGX_ALLADAPTERS) {
644                 for (adapter = 0; adapter < HPI_MAX_ADAPTERS; adapter++) {
645 
646                         hpi_init_response(&hr, HPI_OBJ_ADAPTER,
647                                 HPI_ADAPTER_OPEN, HPI_ERROR_BAD_ADAPTER);
648                         memcpy(&rESP_HPI_ADAPTER_OPEN[adapter], &hr,
649                                 sizeof(rESP_HPI_ADAPTER_OPEN[adapter]));
650 
651                         hpi_init_response(&hr, HPI_OBJ_MIXER, HPI_MIXER_OPEN,
652                                 HPI_ERROR_INVALID_OBJ);
653                         memcpy(&rESP_HPI_MIXER_OPEN[adapter], &hr,
654                                 sizeof(rESP_HPI_MIXER_OPEN[adapter]));
655 
656                         for (i = 0; i < HPI_MAX_STREAMS; i++) {
657                                 hpi_init_response(&hr, HPI_OBJ_OSTREAM,
658                                         HPI_OSTREAM_OPEN,
659                                         HPI_ERROR_INVALID_OBJ);
660                                 memcpy(&rESP_HPI_OSTREAM_OPEN[adapter][i],
661                                         &hr,
662                                         sizeof(rESP_HPI_OSTREAM_OPEN[adapter]
663                                                 [i]));
664                                 hpi_init_response(&hr, HPI_OBJ_ISTREAM,
665                                         HPI_ISTREAM_OPEN,
666                                         HPI_ERROR_INVALID_OBJ);
667                                 memcpy(&rESP_HPI_ISTREAM_OPEN[adapter][i],
668                                         &hr,
669                                         sizeof(rESP_HPI_ISTREAM_OPEN[adapter]
670                                                 [i]));
671                         }
672                 }
673         } else if (adapter_index < HPI_MAX_ADAPTERS) {
674                 rESP_HPI_ADAPTER_OPEN[adapter_index].h.error =
675                         HPI_ERROR_BAD_ADAPTER;
676                 rESP_HPI_MIXER_OPEN[adapter_index].h.error =
677                         HPI_ERROR_INVALID_OBJ;
678                 for (i = 0; i < HPI_MAX_STREAMS; i++) {
679                         rESP_HPI_OSTREAM_OPEN[adapter_index][i].h.error =
680                                 HPI_ERROR_INVALID_OBJ;
681                         rESP_HPI_ISTREAM_OPEN[adapter_index][i].h.error =
682                                 HPI_ERROR_INVALID_OBJ;
683                 }
684         }
685 }
686 
687 static u16 HPIMSGX__init(struct hpi_message *phm,
688         /* HPI_SUBSYS_CREATE_ADAPTER structure with */
689         /* resource list or NULL=find all */
690         struct hpi_response *phr
691         /* response from HPI_ADAPTER_GET_INFO */
692         )
693 {
694         hpi_handler_func *entry_point_func;
695         struct hpi_response hr;
696 
697         /* Init response here so we can pass in previous adapter list */
698         hpi_init_response(&hr, phm->object, phm->function,
699                 HPI_ERROR_INVALID_OBJ);
700 
701         entry_point_func =
702                 hpi_lookup_entry_point_function(phm->u.s.resource.r.pci);
703 
704         if (entry_point_func) {
705                 HPI_DEBUG_MESSAGE(DEBUG, phm);
706                 entry_point_func(phm, &hr);
707         } else {
708                 phr->error = HPI_ERROR_PROCESSING_MESSAGE;
709                 return phr->error;
710         }
711         if (hr.error == 0 && hr.u.s.adapter_index < HPI_MAX_ADAPTERS) {
712                 /* the adapter was created successfully
713                    save the mapping for future use */
714                 hpi_entry_points[hr.u.s.adapter_index] = entry_point_func;
715                 /* prepare adapter (pre-open streams etc.) */
716                 HPI_DEBUG_LOG(DEBUG,
717                         "HPI_SUBSYS_CREATE_ADAPTER successful,"
718                         " preparing adapter\n");
719                 adapter_prepare(hr.u.s.adapter_index);
720         }
721         memcpy(phr, &hr, hr.size);
722         return phr->error;
723 }
724 
725 static void HPIMSGX__cleanup(u16 adapter_index, void *h_owner)
726 {
727         int i, adapter, adapter_limit;
728 
729         if (!h_owner)
730                 return;
731 
732         if (adapter_index == HPIMSGX_ALLADAPTERS) {
733                 adapter = 0;
734                 adapter_limit = HPI_MAX_ADAPTERS;
735         } else {
736                 adapter = adapter_index;
737                 adapter_limit = adapter + 1;
738         }
739 
740         for (; adapter < adapter_limit; adapter++) {
741                 /*      printk(KERN_INFO "Cleanup adapter #%d\n",wAdapter); */
742                 for (i = 0; i < HPI_MAX_STREAMS; i++) {
743                         if (h_owner ==
744                                 outstream_user_open[adapter][i].h_owner) {
745                                 struct hpi_message hm;
746                                 struct hpi_response hr;
747 
748                                 HPI_DEBUG_LOG(DEBUG,
749                                         "Close adapter %d ostream %d\n",
750                                         adapter, i);
751 
752                                 hpi_init_message_response(&hm, &hr,
753                                         HPI_OBJ_OSTREAM, HPI_OSTREAM_RESET);
754                                 hm.adapter_index = (u16)adapter;
755                                 hm.obj_index = (u16)i;
756                                 hw_entry_point(&hm, &hr);
757 
758                                 hm.function = HPI_OSTREAM_HOSTBUFFER_FREE;
759                                 hw_entry_point(&hm, &hr);
760 
761                                 hm.function = HPI_OSTREAM_GROUP_RESET;
762                                 hw_entry_point(&hm, &hr);
763 
764                                 outstream_user_open[adapter][i].open_flag = 0;
765                                 outstream_user_open[adapter][i].h_owner =
766                                         NULL;
767                         }
768                         if (h_owner == instream_user_open[adapter][i].h_owner) {
769                                 struct hpi_message hm;
770                                 struct hpi_response hr;
771 
772                                 HPI_DEBUG_LOG(DEBUG,
773                                         "Close adapter %d istream %d\n",
774                                         adapter, i);
775 
776                                 hpi_init_message_response(&hm, &hr,
777                                         HPI_OBJ_ISTREAM, HPI_ISTREAM_RESET);
778                                 hm.adapter_index = (u16)adapter;
779                                 hm.obj_index = (u16)i;
780                                 hw_entry_point(&hm, &hr);
781 
782                                 hm.function = HPI_ISTREAM_HOSTBUFFER_FREE;
783                                 hw_entry_point(&hm, &hr);
784 
785                                 hm.function = HPI_ISTREAM_GROUP_RESET;
786                                 hw_entry_point(&hm, &hr);
787 
788                                 instream_user_open[adapter][i].open_flag = 0;
789                                 instream_user_open[adapter][i].h_owner = NULL;
790                         }
791                 }
792         }
793 }
794 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

sflogo.php