linux/drivers/staging/tidspbridge/rmgr/drv_interface.c
<<
>>
Prefs
   1/*
   2 * drv_interface.c
   3 *
   4 * DSP-BIOS Bridge driver support functions for TI OMAP processors.
   5 *
   6 * DSP/BIOS Bridge driver interface.
   7 *
   8 * Copyright (C) 2005-2006 Texas Instruments, Inc.
   9 *
  10 * This package is free software; you can redistribute it and/or modify
  11 * it under the terms of the GNU General Public License version 2 as
  12 * published by the Free Software Foundation.
  13 *
  14 * THIS PACKAGE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
  15 * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
  16 * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  17 */
  18
  19#include <linux/platform_data/dsp-omap.h>
  20
  21#include <linux/types.h>
  22#include <linux/platform_device.h>
  23#include <linux/pm.h>
  24#include <linux/module.h>
  25#include <linux/device.h>
  26#include <linux/init.h>
  27#include <linux/moduleparam.h>
  28#include <linux/cdev.h>
  29
  30/*  ----------------------------------- DSP/BIOS Bridge */
  31#include <dspbridge/dbdefs.h>
  32
  33/*  ----------------------------------- OS Adaptation Layer */
  34#include <dspbridge/clk.h>
  35
  36/*  ----------------------------------- Platform Manager */
  37#include <dspbridge/dspapi.h>
  38#include <dspbridge/dspdrv.h>
  39
  40/*  ----------------------------------- Resource Manager */
  41#include <dspbridge/pwr.h>
  42
  43#include <dspbridge/resourcecleanup.h>
  44#include <dspbridge/proc.h>
  45#include <dspbridge/dev.h>
  46
  47#ifdef CONFIG_TIDSPBRIDGE_DVFS
  48#include <mach-omap2/omap3-opp.h>
  49#endif
  50
  51/*  ----------------------------------- Globals */
  52#define DSPBRIDGE_VERSION       "0.3"
  53s32 dsp_debug;
  54
  55struct platform_device *omap_dspbridge_dev;
  56struct device *bridge;
  57
  58/* This is a test variable used by Bridge to test different sleep states */
  59s32 dsp_test_sleepstate;
  60
  61static struct cdev bridge_cdev;
  62
  63static struct class *bridge_class;
  64
  65static u32 driver_context;
  66static s32 driver_major;
  67static char *base_img;
  68char *iva_img;
  69static s32 shm_size = 0x500000; /* 5 MB */
  70static int tc_wordswapon;       /* Default value is always false */
  71#ifdef CONFIG_TIDSPBRIDGE_RECOVERY
  72#define REC_TIMEOUT 5000        /*recovery timeout in msecs */
  73static atomic_t bridge_cref;    /* number of bridge open handles */
  74static struct workqueue_struct *bridge_rec_queue;
  75static struct work_struct bridge_recovery_work;
  76static DECLARE_COMPLETION(bridge_comp);
  77static DECLARE_COMPLETION(bridge_open_comp);
  78static bool recover;
  79#endif
  80
  81#ifdef CONFIG_PM
  82struct omap34_xx_bridge_suspend_data {
  83        int suspended;
  84        wait_queue_head_t suspend_wq;
  85};
  86
  87static struct omap34_xx_bridge_suspend_data bridge_suspend_data;
  88
  89static int omap34_xxbridge_suspend_lockout(struct omap34_xx_bridge_suspend_data
  90                                           *s, struct file *f)
  91{
  92        if ((s)->suspended) {
  93                if ((f)->f_flags & O_NONBLOCK)
  94                        return -EPERM;
  95                wait_event_interruptible((s)->suspend_wq, (s)->suspended == 0);
  96        }
  97        return 0;
  98}
  99#endif
 100
 101module_param(dsp_debug, int, 0);
 102MODULE_PARM_DESC(dsp_debug, "Wait after loading DSP image. default = false");
 103
 104module_param(dsp_test_sleepstate, int, 0);
 105MODULE_PARM_DESC(dsp_test_sleepstate, "DSP Sleep state = 0");
 106
 107module_param(base_img, charp, 0);
 108MODULE_PARM_DESC(base_img, "DSP base image, default = NULL");
 109
 110module_param(shm_size, int, 0);
 111MODULE_PARM_DESC(shm_size, "shm size, default = 4 MB, minimum = 64 KB");
 112
 113module_param(tc_wordswapon, int, 0);
 114MODULE_PARM_DESC(tc_wordswapon, "TC Word Swap Option. default = 0");
 115
 116MODULE_AUTHOR("Texas Instruments");
 117MODULE_LICENSE("GPL");
 118MODULE_VERSION(DSPBRIDGE_VERSION);
 119
 120/*
 121 * This function is called when an application opens handle to the
 122 * bridge driver.
 123 */
 124static int bridge_open(struct inode *ip, struct file *filp)
 125{
 126        int status = 0;
 127        struct process_context *pr_ctxt = NULL;
 128
 129        /*
 130         * Allocate a new process context and insert it into global
 131         * process context list.
 132         */
 133
 134#ifdef CONFIG_TIDSPBRIDGE_RECOVERY
 135        if (recover) {
 136                if (filp->f_flags & O_NONBLOCK ||
 137                    wait_for_completion_interruptible(&bridge_open_comp))
 138                        return -EBUSY;
 139        }
 140#endif
 141        pr_ctxt = kzalloc(sizeof(struct process_context), GFP_KERNEL);
 142        if (!pr_ctxt)
 143                return -ENOMEM;
 144
 145        pr_ctxt->res_state = PROC_RES_ALLOCATED;
 146        spin_lock_init(&pr_ctxt->dmm_map_lock);
 147        INIT_LIST_HEAD(&pr_ctxt->dmm_map_list);
 148        spin_lock_init(&pr_ctxt->dmm_rsv_lock);
 149        INIT_LIST_HEAD(&pr_ctxt->dmm_rsv_list);
 150
 151        pr_ctxt->node_id = kzalloc(sizeof(struct idr), GFP_KERNEL);
 152        if (!pr_ctxt->node_id) {
 153                status = -ENOMEM;
 154                goto err1;
 155        }
 156
 157        idr_init(pr_ctxt->node_id);
 158
 159        pr_ctxt->stream_id = kzalloc(sizeof(struct idr), GFP_KERNEL);
 160        if (!pr_ctxt->stream_id) {
 161                status = -ENOMEM;
 162                goto err2;
 163        }
 164
 165        idr_init(pr_ctxt->stream_id);
 166
 167        filp->private_data = pr_ctxt;
 168
 169#ifdef CONFIG_TIDSPBRIDGE_RECOVERY
 170        atomic_inc(&bridge_cref);
 171#endif
 172        return 0;
 173
 174err2:
 175        kfree(pr_ctxt->node_id);
 176err1:
 177        kfree(pr_ctxt);
 178        return status;
 179}
 180
 181/*
 182 * This function is called when an application closes handle to the bridge
 183 * driver.
 184 */
 185static int bridge_release(struct inode *ip, struct file *filp)
 186{
 187        int status = 0;
 188        struct process_context *pr_ctxt;
 189
 190        if (!filp->private_data) {
 191                status = -EIO;
 192                goto err;
 193        }
 194
 195        pr_ctxt = filp->private_data;
 196        flush_signals(current);
 197        drv_remove_all_resources(pr_ctxt);
 198        proc_detach(pr_ctxt);
 199        kfree(pr_ctxt->node_id);
 200        kfree(pr_ctxt->stream_id);
 201        kfree(pr_ctxt);
 202
 203        filp->private_data = NULL;
 204
 205err:
 206#ifdef CONFIG_TIDSPBRIDGE_RECOVERY
 207        if (!atomic_dec_return(&bridge_cref))
 208                complete(&bridge_comp);
 209#endif
 210        return status;
 211}
 212
 213/* This function provides IO interface to the bridge driver. */
 214static long bridge_ioctl(struct file *filp, unsigned int code,
 215                         unsigned long args)
 216{
 217        int status;
 218        u32 retval = 0;
 219        union trapped_args buf_in;
 220
 221#ifdef CONFIG_TIDSPBRIDGE_RECOVERY
 222        if (recover) {
 223                status = -EIO;
 224                goto err;
 225        }
 226#endif
 227#ifdef CONFIG_PM
 228        status = omap34_xxbridge_suspend_lockout(&bridge_suspend_data, filp);
 229        if (status != 0)
 230                return status;
 231#endif
 232
 233        if (!filp->private_data) {
 234                status = -EIO;
 235                goto err;
 236        }
 237
 238        status = copy_from_user(&buf_in, (union trapped_args *)args,
 239                                sizeof(union trapped_args));
 240
 241        if (!status) {
 242                status = api_call_dev_ioctl(code, &buf_in, &retval,
 243                                            filp->private_data);
 244
 245                if (!status) {
 246                        status = retval;
 247                } else {
 248                        dev_dbg(bridge, "%s: IOCTL Failed, code: 0x%x "
 249                                "status 0x%x\n", __func__, code, status);
 250                        status = -1;
 251                }
 252
 253        }
 254
 255err:
 256        return status;
 257}
 258
 259/* This function maps kernel space memory to user space memory. */
 260static int bridge_mmap(struct file *filp, struct vm_area_struct *vma)
 261{
 262        u32 status;
 263
 264        /* VM_IO | VM_DONTEXPAND | VM_DONTDUMP are set by remap_pfn_range() */
 265        vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
 266
 267        dev_dbg(bridge, "%s: vm filp %p start %lx end %lx page_prot %ulx "
 268                "flags %lx\n", __func__, filp,
 269                vma->vm_start, vma->vm_end, vma->vm_page_prot,
 270                vma->vm_flags);
 271
 272        status = remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff,
 273                                 vma->vm_end - vma->vm_start,
 274                                 vma->vm_page_prot);
 275        if (status != 0)
 276                status = -EAGAIN;
 277
 278        return status;
 279}
 280
 281static const struct file_operations bridge_fops = {
 282        .open = bridge_open,
 283        .release = bridge_release,
 284        .unlocked_ioctl = bridge_ioctl,
 285        .mmap = bridge_mmap,
 286        .llseek = noop_llseek,
 287};
 288
 289#ifdef CONFIG_PM
 290static u32 time_out = 1000;
 291#ifdef CONFIG_TIDSPBRIDGE_DVFS
 292s32 dsp_max_opps = VDD1_OPP5;
 293#endif
 294
 295/* Maximum Opps that can be requested by IVA */
 296/*vdd1 rate table */
 297#ifdef CONFIG_TIDSPBRIDGE_DVFS
 298const struct omap_opp vdd1_rate_table_bridge[] = {
 299        {0, 0, 0},
 300        /*OPP1 */
 301        {S125M, VDD1_OPP1, 0},
 302        /*OPP2 */
 303        {S250M, VDD1_OPP2, 0},
 304        /*OPP3 */
 305        {S500M, VDD1_OPP3, 0},
 306        /*OPP4 */
 307        {S550M, VDD1_OPP4, 0},
 308        /*OPP5 */
 309        {S600M, VDD1_OPP5, 0},
 310};
 311#endif
 312#endif
 313
 314struct omap_dsp_platform_data *omap_dspbridge_pdata;
 315
 316u32 vdd1_dsp_freq[6][4] = {
 317        {0, 0, 0, 0},
 318        /*OPP1 */
 319        {0, 90000, 0, 86000},
 320        /*OPP2 */
 321        {0, 180000, 80000, 170000},
 322        /*OPP3 */
 323        {0, 360000, 160000, 340000},
 324        /*OPP4 */
 325        {0, 396000, 325000, 376000},
 326        /*OPP5 */
 327        {0, 430000, 355000, 430000},
 328};
 329
 330#ifdef CONFIG_TIDSPBRIDGE_RECOVERY
 331static void bridge_recover(struct work_struct *work)
 332{
 333        struct dev_object *dev;
 334        struct cfg_devnode *dev_node;
 335        if (atomic_read(&bridge_cref)) {
 336                INIT_COMPLETION(bridge_comp);
 337                while (!wait_for_completion_timeout(&bridge_comp,
 338                                                msecs_to_jiffies(REC_TIMEOUT)))
 339                        pr_info("%s:%d handle(s) still opened\n",
 340                                        __func__, atomic_read(&bridge_cref));
 341        }
 342        dev = dev_get_first();
 343        dev_get_dev_node(dev, &dev_node);
 344        if (!dev_node || proc_auto_start(dev_node, dev))
 345                pr_err("DSP could not be restarted\n");
 346        recover = false;
 347        complete_all(&bridge_open_comp);
 348}
 349
 350void bridge_recover_schedule(void)
 351{
 352        INIT_COMPLETION(bridge_open_comp);
 353        recover = true;
 354        queue_work(bridge_rec_queue, &bridge_recovery_work);
 355}
 356#endif
 357#ifdef CONFIG_TIDSPBRIDGE_DVFS
 358static int dspbridge_scale_notification(struct notifier_block *op,
 359                                        unsigned long val, void *ptr)
 360{
 361        struct omap_dsp_platform_data *pdata =
 362            omap_dspbridge_dev->dev.platform_data;
 363
 364        if (CPUFREQ_POSTCHANGE == val && pdata->dsp_get_opp)
 365                pwr_pm_post_scale(PRCM_VDD1, pdata->dsp_get_opp());
 366
 367        return 0;
 368}
 369
 370static struct notifier_block iva_clk_notifier = {
 371        .notifier_call = dspbridge_scale_notification,
 372        NULL,
 373};
 374#endif
 375
 376/**
 377 * omap3_bridge_startup() - perform low lever initializations
 378 * @pdev:      pointer to platform device
 379 *
 380 * Initializes recovery, PM and DVFS required data, before calling
 381 * clk and memory init routines.
 382 */
 383static int omap3_bridge_startup(struct platform_device *pdev)
 384{
 385        struct omap_dsp_platform_data *pdata = pdev->dev.platform_data;
 386        struct drv_data *drv_datap = NULL;
 387        u32 phys_membase, phys_memsize;
 388        int err;
 389
 390#ifdef CONFIG_TIDSPBRIDGE_RECOVERY
 391        bridge_rec_queue = create_workqueue("bridge_rec_queue");
 392        INIT_WORK(&bridge_recovery_work, bridge_recover);
 393        INIT_COMPLETION(bridge_comp);
 394#endif
 395
 396#ifdef CONFIG_PM
 397        /* Initialize the wait queue */
 398        bridge_suspend_data.suspended = 0;
 399        init_waitqueue_head(&bridge_suspend_data.suspend_wq);
 400
 401#ifdef CONFIG_TIDSPBRIDGE_DVFS
 402        for (i = 0; i < 6; i++)
 403                pdata->mpu_speed[i] = vdd1_rate_table_bridge[i].rate;
 404
 405        err = cpufreq_register_notifier(&iva_clk_notifier,
 406                                        CPUFREQ_TRANSITION_NOTIFIER);
 407        if (err)
 408                pr_err("%s: clk_notifier_register failed for iva2_ck\n",
 409                                                                __func__);
 410#endif
 411#endif
 412
 413        dsp_clk_init();
 414
 415        drv_datap = kzalloc(sizeof(struct drv_data), GFP_KERNEL);
 416        if (!drv_datap) {
 417                err = -ENOMEM;
 418                goto err1;
 419        }
 420
 421        drv_datap->shm_size = shm_size;
 422        drv_datap->tc_wordswapon = tc_wordswapon;
 423
 424        if (base_img) {
 425                drv_datap->base_img = kmalloc(strlen(base_img) + 1, GFP_KERNEL);
 426                if (!drv_datap->base_img) {
 427                        err = -ENOMEM;
 428                        goto err2;
 429                }
 430                strncpy(drv_datap->base_img, base_img, strlen(base_img) + 1);
 431        }
 432
 433        dev_set_drvdata(bridge, drv_datap);
 434
 435        if (shm_size < 0x10000) {       /* 64 KB */
 436                err = -EINVAL;
 437                pr_err("%s: shm size must be at least 64 KB\n", __func__);
 438                goto err3;
 439        }
 440        dev_dbg(bridge, "%s: requested shm_size = 0x%x\n", __func__, shm_size);
 441
 442        phys_membase = pdata->phys_mempool_base;
 443        phys_memsize = pdata->phys_mempool_size;
 444        if (phys_membase > 0 && phys_memsize > 0)
 445                mem_ext_phys_pool_init(phys_membase, phys_memsize);
 446
 447        if (tc_wordswapon)
 448                dev_dbg(bridge, "%s: TC Word Swap is enabled\n", __func__);
 449
 450        driver_context = dsp_init(&err);
 451        if (err) {
 452                pr_err("DSP Bridge driver initialization failed\n");
 453                goto err4;
 454        }
 455
 456        return 0;
 457
 458err4:
 459        mem_ext_phys_pool_release();
 460err3:
 461        kfree(drv_datap->base_img);
 462err2:
 463        kfree(drv_datap);
 464err1:
 465#ifdef CONFIG_TIDSPBRIDGE_DVFS
 466        cpufreq_unregister_notifier(&iva_clk_notifier,
 467                                    CPUFREQ_TRANSITION_NOTIFIER);
 468#endif
 469        dsp_clk_exit();
 470
 471        return err;
 472}
 473
 474static int omap34_xx_bridge_probe(struct platform_device *pdev)
 475{
 476        int err;
 477        dev_t dev = 0;
 478#ifdef CONFIG_TIDSPBRIDGE_DVFS
 479        int i = 0;
 480#endif
 481
 482        omap_dspbridge_dev = pdev;
 483
 484        /* Global bridge device */
 485        bridge = &omap_dspbridge_dev->dev;
 486
 487        /* Bridge low level initializations */
 488        err = omap3_bridge_startup(pdev);
 489        if (err)
 490                goto err1;
 491
 492        /* use 2.6 device model */
 493        err = alloc_chrdev_region(&dev, 0, 1, "DspBridge");
 494        if (err) {
 495                pr_err("%s: Can't get major %d\n", __func__, driver_major);
 496                goto err1;
 497        }
 498
 499        cdev_init(&bridge_cdev, &bridge_fops);
 500        bridge_cdev.owner = THIS_MODULE;
 501
 502        err = cdev_add(&bridge_cdev, dev, 1);
 503        if (err) {
 504                pr_err("%s: Failed to add bridge device\n", __func__);
 505                goto err2;
 506        }
 507
 508        /* udev support */
 509        bridge_class = class_create(THIS_MODULE, "ti_bridge");
 510        if (IS_ERR(bridge_class)) {
 511                pr_err("%s: Error creating bridge class\n", __func__);
 512                goto err3;
 513        }
 514
 515        driver_major = MAJOR(dev);
 516        device_create(bridge_class, NULL, MKDEV(driver_major, 0),
 517                      NULL, "DspBridge");
 518        pr_info("DSP Bridge driver loaded\n");
 519
 520        return 0;
 521
 522err3:
 523        cdev_del(&bridge_cdev);
 524err2:
 525        unregister_chrdev_region(dev, 1);
 526err1:
 527        return err;
 528}
 529
 530static int omap34_xx_bridge_remove(struct platform_device *pdev)
 531{
 532        dev_t devno;
 533        int status = 0;
 534        struct drv_data *drv_datap = dev_get_drvdata(bridge);
 535
 536        /* Retrieve the Object handle from the driver data */
 537        if (!drv_datap || !drv_datap->drv_object) {
 538                status = -ENODATA;
 539                pr_err("%s: Failed to retrieve the object handle\n", __func__);
 540                goto func_cont;
 541        }
 542
 543#ifdef CONFIG_TIDSPBRIDGE_DVFS
 544        if (cpufreq_unregister_notifier(&iva_clk_notifier,
 545                                        CPUFREQ_TRANSITION_NOTIFIER))
 546                pr_err("%s: cpufreq_unregister_notifier failed for iva2_ck\n",
 547                       __func__);
 548#endif /* #ifdef CONFIG_TIDSPBRIDGE_DVFS */
 549
 550        if (driver_context) {
 551                /* Put the DSP in reset state */
 552                dsp_deinit(driver_context);
 553                driver_context = 0;
 554        }
 555
 556        kfree(drv_datap);
 557        dev_set_drvdata(bridge, NULL);
 558
 559func_cont:
 560        mem_ext_phys_pool_release();
 561
 562        dsp_clk_exit();
 563
 564        devno = MKDEV(driver_major, 0);
 565        cdev_del(&bridge_cdev);
 566        unregister_chrdev_region(devno, 1);
 567        if (bridge_class) {
 568                /* remove the device from sysfs */
 569                device_destroy(bridge_class, MKDEV(driver_major, 0));
 570                class_destroy(bridge_class);
 571
 572        }
 573        return 0;
 574}
 575
 576#ifdef CONFIG_PM
 577static int bridge_suspend(struct platform_device *pdev, pm_message_t state)
 578{
 579        u32 status;
 580        u32 command = PWR_EMERGENCYDEEPSLEEP;
 581
 582        status = pwr_sleep_dsp(command, time_out);
 583        if (status)
 584                return -1;
 585
 586        bridge_suspend_data.suspended = 1;
 587        return 0;
 588}
 589
 590static int bridge_resume(struct platform_device *pdev)
 591{
 592        u32 status;
 593
 594        status = pwr_wake_dsp(time_out);
 595        if (status)
 596                return -1;
 597
 598        bridge_suspend_data.suspended = 0;
 599        wake_up(&bridge_suspend_data.suspend_wq);
 600        return 0;
 601}
 602#endif
 603
 604static struct platform_driver bridge_driver = {
 605        .driver = {
 606                   .name = "omap-dsp",
 607                   },
 608        .probe = omap34_xx_bridge_probe,
 609        .remove = omap34_xx_bridge_remove,
 610#ifdef CONFIG_PM
 611        .suspend = bridge_suspend,
 612        .resume = bridge_resume,
 613#endif
 614};
 615
 616/* To remove all process resources before removing the process from the
 617 * process context list */
 618int drv_remove_all_resources(void *process_ctxt)
 619{
 620        int status = 0;
 621        struct process_context *ctxt = (struct process_context *)process_ctxt;
 622        drv_remove_all_strm_res_elements(ctxt);
 623        drv_remove_all_node_res_elements(ctxt);
 624        drv_remove_all_dmm_res_elements(ctxt);
 625        ctxt->res_state = PROC_RES_FREED;
 626        return status;
 627}
 628
 629module_platform_driver(bridge_driver);
 630