1/******************************************************************************* 2 AudioScience HPI driver 3 Common Linux HPI ioctl and module probe/remove functions 4 5 Copyright (C) 1997-2014 AudioScience Inc. <support@audioscience.com> 6 7 This program is free software; you can redistribute it and/or modify 8 it under the terms of version 2 of the GNU General Public License as 9 published by the Free Software Foundation; 10 11 This program is distributed in the hope that it will be useful, 12 but WITHOUT ANY WARRANTY; without even the implied warranty of 13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 GNU General Public License for more details. 15 16*******************************************************************************/ 17#define SOURCEFILE_NAME "hpioctl.c" 18 19#include "hpi_internal.h" 20#include "hpi_version.h" 21#include "hpimsginit.h" 22#include "hpidebug.h" 23#include "hpimsgx.h" 24#include "hpioctl.h" 25#include "hpicmn.h" 26 27#include <linux/fs.h> 28#include <linux/interrupt.h> 29#include <linux/slab.h> 30#include <linux/moduleparam.h> 31#include <linux/uaccess.h> 32#include <linux/pci.h> 33#include <linux/stringify.h> 34#include <linux/module.h> 35 36#ifdef MODULE_FIRMWARE 37MODULE_FIRMWARE("asihpi/dsp5000.bin"); 38MODULE_FIRMWARE("asihpi/dsp6200.bin"); 39MODULE_FIRMWARE("asihpi/dsp6205.bin"); 40MODULE_FIRMWARE("asihpi/dsp6400.bin"); 41MODULE_FIRMWARE("asihpi/dsp6600.bin"); 42MODULE_FIRMWARE("asihpi/dsp8700.bin"); 43MODULE_FIRMWARE("asihpi/dsp8900.bin"); 44#endif 45 46static int prealloc_stream_buf; 47module_param(prealloc_stream_buf, int, S_IRUGO); 48MODULE_PARM_DESC(prealloc_stream_buf, 49 "Preallocate size for per-adapter stream buffer"); 50 51/* Allow the debug level to be changed after module load. 52 E.g. echo 2 > /sys/module/asihpi/parameters/hpiDebugLevel 53*/ 54module_param(hpi_debug_level, int, S_IRUGO | S_IWUSR); 55MODULE_PARM_DESC(hpi_debug_level, "debug verbosity 0..5"); 56 57/* List of adapters found */ 58static struct hpi_adapter adapters[HPI_MAX_ADAPTERS]; 59 60/* Wrapper function to HPI_Message to enable dumping of the 61 message and response types. 62*/ 63static void hpi_send_recv_f(struct hpi_message *phm, struct hpi_response *phr, 64 struct file *file) 65{ 66 if ((phm->adapter_index >= HPI_MAX_ADAPTERS) 67 && (phm->object != HPI_OBJ_SUBSYSTEM)) 68 phr->error = HPI_ERROR_INVALID_OBJ_INDEX; 69 else 70 hpi_send_recv_ex(phm, phr, file); 71} 72 73/* This is called from hpifunc.c functions, called by ALSA 74 * (or other kernel process) In this case there is no file descriptor 75 * available for the message cache code 76 */ 77void hpi_send_recv(struct hpi_message *phm, struct hpi_response *phr) 78{ 79 hpi_send_recv_f(phm, phr, HOWNER_KERNEL); 80} 81 82EXPORT_SYMBOL(hpi_send_recv); 83/* for radio-asihpi */ 84 85int asihpi_hpi_release(struct file *file) 86{ 87 struct hpi_message hm; 88 struct hpi_response hr; 89 90/* HPI_DEBUG_LOG(INFO,"hpi_release file %p, pid %d\n", file, current->pid); */ 91 /* close the subsystem just in case the application forgot to. */ 92 hpi_init_message_response(&hm, &hr, HPI_OBJ_SUBSYSTEM, 93 HPI_SUBSYS_CLOSE); 94 hpi_send_recv_ex(&hm, &hr, file); 95 return 0; 96} 97 98long asihpi_hpi_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 99{ 100 struct hpi_ioctl_linux __user *phpi_ioctl_data; 101 void __user *puhm; 102 void __user *puhr; 103 union hpi_message_buffer_v1 *hm; 104 union hpi_response_buffer_v1 *hr; 105 u16 res_max_size; 106 u32 uncopied_bytes; 107 int err = 0; 108 109 if (cmd != HPI_IOCTL_LINUX) 110 return -EINVAL; 111 112 hm = kmalloc(sizeof(*hm), GFP_KERNEL); 113 hr = kmalloc(sizeof(*hr), GFP_KERNEL); 114 if (!hm || !hr) { 115 err = -ENOMEM; 116 goto out; 117 } 118 119 phpi_ioctl_data = (struct hpi_ioctl_linux __user *)arg; 120 121 /* Read the message and response pointers from user space. */ 122 if (get_user(puhm, &phpi_ioctl_data->phm) 123 || get_user(puhr, &phpi_ioctl_data->phr)) { 124 err = -EFAULT; 125 goto out; 126 } 127 128 /* Now read the message size and data from user space. */ 129 if (get_user(hm->h.size, (u16 __user *)puhm)) { 130 err = -EFAULT; 131 goto out; 132 } 133 if (hm->h.size > sizeof(*hm)) 134 hm->h.size = sizeof(*hm); 135 136 /* printk(KERN_INFO "message size %d\n", hm->h.wSize); */ 137 138 uncopied_bytes = copy_from_user(hm, puhm, hm->h.size); 139 if (uncopied_bytes) { 140 HPI_DEBUG_LOG(ERROR, "uncopied bytes %d\n", uncopied_bytes); 141 err = -EFAULT; 142 goto out; 143 } 144 145 if (get_user(res_max_size, (u16 __user *)puhr)) { 146 err = -EFAULT; 147 goto out; 148 } 149 /* printk(KERN_INFO "user response size %d\n", res_max_size); */ 150 if (res_max_size < sizeof(struct hpi_response_header)) { 151 HPI_DEBUG_LOG(WARNING, "small res size %d\n", res_max_size); 152 err = -EFAULT; 153 goto out; 154 } 155 156 res_max_size = min_t(size_t, res_max_size, sizeof(*hr)); 157 158 switch (hm->h.function) { 159 case HPI_SUBSYS_CREATE_ADAPTER: 160 case HPI_ADAPTER_DELETE: 161 /* Application must not use these functions! */ 162 hr->h.size = sizeof(hr->h); 163 hr->h.error = HPI_ERROR_INVALID_OPERATION; 164 hr->h.function = hm->h.function; 165 uncopied_bytes = copy_to_user(puhr, hr, hr->h.size); 166 if (uncopied_bytes) 167 err = -EFAULT; 168 else 169 err = 0; 170 goto out; 171 } 172 173 hr->h.size = res_max_size; 174 if (hm->h.object == HPI_OBJ_SUBSYSTEM) { 175 hpi_send_recv_f(&hm->m0, &hr->r0, file); 176 } else { 177 u16 __user *ptr = NULL; 178 u32 size = 0; 179 /* -1=no data 0=read from user mem, 1=write to user mem */ 180 int wrflag = -1; 181 struct hpi_adapter *pa = NULL; 182 183 if (hm->h.adapter_index < ARRAY_SIZE(adapters)) 184 pa = &adapters[hm->h.adapter_index]; 185 186 if (!pa || !pa->adapter || !pa->adapter->type) { 187 hpi_init_response(&hr->r0, hm->h.object, 188 hm->h.function, HPI_ERROR_BAD_ADAPTER_NUMBER); 189 190 uncopied_bytes = 191 copy_to_user(puhr, hr, sizeof(hr->h)); 192 if (uncopied_bytes) 193 err = -EFAULT; 194 else 195 err = 0; 196 goto out; 197 } 198 199 if (mutex_lock_interruptible(&pa->mutex)) { 200 err = -EINTR; 201 goto out; 202 } 203 204 /* Dig out any pointers embedded in the message. */ 205 switch (hm->h.function) { 206 case HPI_OSTREAM_WRITE: 207 case HPI_ISTREAM_READ:{ 208 /* Yes, sparse, this is correct. */ 209 ptr = (u16 __user *)hm->m0.u.d.u.data.pb_data; 210 size = hm->m0.u.d.u.data.data_size; 211 212 /* Allocate buffer according to application request. 213 ?Is it better to alloc/free for the duration 214 of the transaction? 215 */ 216 if (pa->buffer_size < size) { 217 HPI_DEBUG_LOG(DEBUG, 218 "Realloc adapter %d stream " 219 "buffer from %zd to %d\n", 220 hm->h.adapter_index, 221 pa->buffer_size, size); 222 if (pa->p_buffer) { 223 pa->buffer_size = 0; 224 vfree(pa->p_buffer); 225 } 226 pa->p_buffer = vmalloc(size); 227 if (pa->p_buffer) 228 pa->buffer_size = size; 229 else { 230 HPI_DEBUG_LOG(ERROR, 231 "HPI could not allocate " 232 "stream buffer size %d\n", 233 size); 234 235 mutex_unlock(&pa->mutex); 236 err = -EINVAL; 237 goto out; 238 } 239 } 240 241 hm->m0.u.d.u.data.pb_data = pa->p_buffer; 242 if (hm->h.function == HPI_ISTREAM_READ) 243 /* from card, WRITE to user mem */ 244 wrflag = 1; 245 else 246 wrflag = 0; 247 break; 248 } 249 250 default: 251 size = 0; 252 break; 253 } 254 255 if (size && (wrflag == 0)) { 256 uncopied_bytes = 257 copy_from_user(pa->p_buffer, ptr, size); 258 if (uncopied_bytes) 259 HPI_DEBUG_LOG(WARNING, 260 "Missed %d of %d " 261 "bytes from user\n", uncopied_bytes, 262 size); 263 } 264 265 hpi_send_recv_f(&hm->m0, &hr->r0, file); 266 267 if (size && (wrflag == 1)) { 268 uncopied_bytes = 269 copy_to_user(ptr, pa->p_buffer, size); 270 if (uncopied_bytes) 271 HPI_DEBUG_LOG(WARNING, 272 "Missed %d of %d " "bytes to user\n", 273 uncopied_bytes, size); 274 } 275 276 mutex_unlock(&pa->mutex); 277 } 278 279 /* on return response size must be set */ 280 /*printk(KERN_INFO "response size %d\n", hr->h.wSize); */ 281 282 if (!hr->h.size) { 283 HPI_DEBUG_LOG(ERROR, "response zero size\n"); 284 err = -EFAULT; 285 goto out; 286 } 287 288 if (hr->h.size > res_max_size) { 289 HPI_DEBUG_LOG(ERROR, "response too big %d %d\n", hr->h.size, 290 res_max_size); 291 hr->h.error = HPI_ERROR_RESPONSE_BUFFER_TOO_SMALL; 292 hr->h.specific_error = hr->h.size; 293 hr->h.size = sizeof(hr->h); 294 } 295 296 uncopied_bytes = copy_to_user(puhr, hr, hr->h.size); 297 if (uncopied_bytes) { 298 HPI_DEBUG_LOG(ERROR, "uncopied bytes %d\n", uncopied_bytes); 299 err = -EFAULT; 300 goto out; 301 } 302 303out: 304 kfree(hm); 305 kfree(hr); 306 return err; 307} 308 309static int asihpi_irq_count; 310 311static irqreturn_t asihpi_isr(int irq, void *dev_id) 312{ 313 struct hpi_adapter *a = dev_id; 314 int handled; 315 316 if (!a->adapter->irq_query_and_clear) { 317 pr_err("asihpi_isr ASI%04X:%d no handler\n", a->adapter->type, 318 a->adapter->index); 319 return IRQ_NONE; 320 } 321 322 handled = a->adapter->irq_query_and_clear(a->adapter, 0); 323 324 if (!handled) 325 return IRQ_NONE; 326 327 asihpi_irq_count++; 328 /* printk(KERN_INFO "asihpi_isr %d ASI%04X:%d irq handled\n", 329 asihpi_irq_count, a->adapter->type, a->adapter->index); */ 330 331 if (a->interrupt_callback) 332 a->interrupt_callback(a); 333 334 return IRQ_HANDLED; 335} 336 337int asihpi_adapter_probe(struct pci_dev *pci_dev, 338 const struct pci_device_id *pci_id) 339{ 340 int idx, nm, low_latency_mode = 0, irq_supported = 0; 341 int adapter_index; 342 unsigned int memlen; 343 struct hpi_message hm; 344 struct hpi_response hr; 345 struct hpi_adapter adapter; 346 struct hpi_pci pci; 347 348 memset(&adapter, 0, sizeof(adapter)); 349 350 dev_printk(KERN_DEBUG, &pci_dev->dev, 351 "probe %04x:%04x,%04x:%04x,%04x\n", pci_dev->vendor, 352 pci_dev->device, pci_dev->subsystem_vendor, 353 pci_dev->subsystem_device, pci_dev->devfn); 354 355 if (pci_enable_device(pci_dev) < 0) { 356 dev_err(&pci_dev->dev, 357 "pci_enable_device failed, disabling device\n"); 358 return -EIO; 359 } 360 361 pci_set_master(pci_dev); /* also sets latency timer if < 16 */ 362 363 hpi_init_message_response(&hm, &hr, HPI_OBJ_SUBSYSTEM, 364 HPI_SUBSYS_CREATE_ADAPTER); 365 hpi_init_response(&hr, HPI_OBJ_SUBSYSTEM, HPI_SUBSYS_CREATE_ADAPTER, 366 HPI_ERROR_PROCESSING_MESSAGE); 367 368 hm.adapter_index = HPI_ADAPTER_INDEX_INVALID; 369 370 nm = HPI_MAX_ADAPTER_MEM_SPACES; 371 372 for (idx = 0; idx < nm; idx++) { 373 HPI_DEBUG_LOG(INFO, "resource %d %pR\n", idx, 374 &pci_dev->resource[idx]); 375 376 if (pci_resource_flags(pci_dev, idx) & IORESOURCE_MEM) { 377 memlen = pci_resource_len(pci_dev, idx); 378 pci.ap_mem_base[idx] = 379 ioremap(pci_resource_start(pci_dev, idx), 380 memlen); 381 if (!pci.ap_mem_base[idx]) { 382 HPI_DEBUG_LOG(ERROR, 383 "ioremap failed, aborting\n"); 384 /* unmap previously mapped pci mem space */ 385 goto err; 386 } 387 } 388 } 389 390 pci.pci_dev = pci_dev; 391 hm.u.s.resource.bus_type = HPI_BUS_PCI; 392 hm.u.s.resource.r.pci = &pci; 393 394 /* call CreateAdapterObject on the relevant hpi module */ 395 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 396 if (hr.error) 397 goto err; 398 399 adapter_index = hr.u.s.adapter_index; 400 adapter.adapter = hpi_find_adapter(adapter_index); 401 402 if (prealloc_stream_buf) { 403 adapter.p_buffer = vmalloc(prealloc_stream_buf); 404 if (!adapter.p_buffer) { 405 HPI_DEBUG_LOG(ERROR, 406 "HPI could not allocate " 407 "kernel buffer size %d\n", 408 prealloc_stream_buf); 409 goto err; 410 } 411 } 412 413 hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER, 414 HPI_ADAPTER_OPEN); 415 hm.adapter_index = adapter.adapter->index; 416 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 417 418 if (hr.error) { 419 HPI_DEBUG_LOG(ERROR, "HPI_ADAPTER_OPEN failed, aborting\n"); 420 goto err; 421 } 422 423 /* Check if current mode == Low Latency mode */ 424 hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER, 425 HPI_ADAPTER_GET_MODE); 426 hm.adapter_index = adapter.adapter->index; 427 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 428 429 if (!hr.error 430 && hr.u.ax.mode.adapter_mode == HPI_ADAPTER_MODE_LOW_LATENCY) 431 low_latency_mode = 1; 432 else 433 dev_info(&pci_dev->dev, 434 "Adapter at index %d is not in low latency mode\n", 435 adapter.adapter->index); 436 437 /* Check if IRQs are supported */ 438 hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER, 439 HPI_ADAPTER_GET_PROPERTY); 440 hm.adapter_index = adapter.adapter->index; 441 hm.u.ax.property_set.property = HPI_ADAPTER_PROPERTY_SUPPORTS_IRQ; 442 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 443 if (hr.error || !hr.u.ax.property_get.parameter1) { 444 dev_info(&pci_dev->dev, 445 "IRQs not supported by adapter at index %d\n", 446 adapter.adapter->index); 447 } else { 448 irq_supported = 1; 449 } 450 451 /* WARNING can't init mutex in 'adapter' 452 * and then copy it to adapters[] ?!?! 453 */ 454 adapters[adapter_index] = adapter; 455 mutex_init(&adapters[adapter_index].mutex); 456 pci_set_drvdata(pci_dev, &adapters[adapter_index]); 457 458 if (low_latency_mode && irq_supported) { 459 if (!adapter.adapter->irq_query_and_clear) { 460 dev_err(&pci_dev->dev, 461 "no IRQ handler for adapter %d, aborting\n", 462 adapter.adapter->index); 463 goto err; 464 } 465 466 /* Disable IRQ generation on DSP side by setting the rate to 0 */ 467 hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER, 468 HPI_ADAPTER_SET_PROPERTY); 469 hm.adapter_index = adapter.adapter->index; 470 hm.u.ax.property_set.property = HPI_ADAPTER_PROPERTY_IRQ_RATE; 471 hm.u.ax.property_set.parameter1 = 0; 472 hm.u.ax.property_set.parameter2 = 0; 473 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 474 if (hr.error) { 475 HPI_DEBUG_LOG(ERROR, 476 "HPI_ADAPTER_GET_MODE failed, aborting\n"); 477 goto err; 478 } 479 480 /* Note: request_irq calls asihpi_isr here */ 481 if (request_irq(pci_dev->irq, asihpi_isr, IRQF_SHARED, 482 "asihpi", &adapters[adapter_index])) { 483 dev_err(&pci_dev->dev, "request_irq(%d) failed\n", 484 pci_dev->irq); 485 goto err; 486 } 487 488 adapters[adapter_index].interrupt_mode = 1; 489 490 dev_info(&pci_dev->dev, "using irq %d\n", pci_dev->irq); 491 adapters[adapter_index].irq = pci_dev->irq; 492 } else { 493 dev_info(&pci_dev->dev, "using polled mode\n"); 494 } 495 496 dev_info(&pci_dev->dev, "probe succeeded for ASI%04X HPI index %d\n", 497 adapter.adapter->type, adapter_index); 498 499 return 0; 500 501err: 502 for (idx = 0; idx < HPI_MAX_ADAPTER_MEM_SPACES; idx++) { 503 if (pci.ap_mem_base[idx]) { 504 iounmap(pci.ap_mem_base[idx]); 505 pci.ap_mem_base[idx] = NULL; 506 } 507 } 508 509 if (adapter.p_buffer) { 510 adapter.buffer_size = 0; 511 vfree(adapter.p_buffer); 512 } 513 514 HPI_DEBUG_LOG(ERROR, "adapter_probe failed\n"); 515 return -ENODEV; 516} 517 518void asihpi_adapter_remove(struct pci_dev *pci_dev) 519{ 520 int idx; 521 struct hpi_message hm; 522 struct hpi_response hr; 523 struct hpi_adapter *pa; 524 struct hpi_pci pci; 525 526 pa = pci_get_drvdata(pci_dev); 527 pci = pa->adapter->pci; 528 529 /* Disable IRQ generation on DSP side */ 530 hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER, 531 HPI_ADAPTER_SET_PROPERTY); 532 hm.adapter_index = pa->adapter->index; 533 hm.u.ax.property_set.property = HPI_ADAPTER_PROPERTY_IRQ_RATE; 534 hm.u.ax.property_set.parameter1 = 0; 535 hm.u.ax.property_set.parameter2 = 0; 536 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 537 538 hpi_init_message_response(&hm, &hr, HPI_OBJ_ADAPTER, 539 HPI_ADAPTER_DELETE); 540 hm.adapter_index = pa->adapter->index; 541 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 542 543 /* unmap PCI memory space, mapped during device init. */ 544 for (idx = 0; idx < HPI_MAX_ADAPTER_MEM_SPACES; ++idx) 545 iounmap(pci.ap_mem_base[idx]); 546 547 if (pa->irq) 548 free_irq(pa->irq, pa); 549 550 vfree(pa->p_buffer); 551 552 if (1) 553 dev_info(&pci_dev->dev, 554 "remove %04x:%04x,%04x:%04x,%04x, HPI index %d\n", 555 pci_dev->vendor, pci_dev->device, 556 pci_dev->subsystem_vendor, pci_dev->subsystem_device, 557 pci_dev->devfn, pa->adapter->index); 558 559 memset(pa, 0, sizeof(*pa)); 560} 561 562void __init asihpi_init(void) 563{ 564 struct hpi_message hm; 565 struct hpi_response hr; 566 567 memset(adapters, 0, sizeof(adapters)); 568 569 printk(KERN_INFO "ASIHPI driver " HPI_VER_STRING "\n"); 570 571 hpi_init_message_response(&hm, &hr, HPI_OBJ_SUBSYSTEM, 572 HPI_SUBSYS_DRIVER_LOAD); 573 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 574} 575 576void asihpi_exit(void) 577{ 578 struct hpi_message hm; 579 struct hpi_response hr; 580 581 hpi_init_message_response(&hm, &hr, HPI_OBJ_SUBSYSTEM, 582 HPI_SUBSYS_DRIVER_UNLOAD); 583 hpi_send_recv_ex(&hm, &hr, HOWNER_KERNEL); 584} 585