LXR linux/arch/arm/mach-omap2/dsp.c

   1/*
   2 * TI's OMAP DSP platform device registration
   3 *
   4 * Copyright (C) 2005-2006 Texas Instruments, Inc.
   5 * Copyright (C) 2009 Nokia Corporation
   6 *
   7 * Written by Hiroshi DOYU <Hiroshi.DOYU@nokia.com>
   8 *
   9 * This program is free software; you can redistribute it and/or modify
  10 * it under the terms of the GNU General Public License version 2 as
  11 * published by the Free Software Foundation.
  12 */
  13
  14/*
  15 * XXX The function pointers to the PRM/CM functions are incorrect and
  16 * should be removed.  No device driver should be changing PRM/CM bits
  17 * directly; that's a layering violation -- those bits are the responsibility
  18 * of the OMAP PM core code.
  19 */
  20
  21#include <linux/module.h>
  22#include <linux/platform_device.h>
  23
  24#include <asm/memblock.h>
  25
  26#include "control.h"
  27#include "cm2xxx_3xxx.h"
  28#include "prm2xxx_3xxx.h"
  29#ifdef CONFIG_TIDSPBRIDGE_DVFS
  30#include "omap-pm.h"
  31#endif
  32
  33#include <linux/platform_data/dsp-omap.h>
  34
  35static struct platform_device *omap_dsp_pdev;
  36
  37static struct omap_dsp_platform_data omap_dsp_pdata __initdata = {
  38#ifdef CONFIG_TIDSPBRIDGE_DVFS
  39        .dsp_set_min_opp = omap_pm_dsp_set_min_opp,
  40        .dsp_get_opp = omap_pm_dsp_get_opp,
  41        .cpu_set_freq = omap_pm_cpu_set_freq,
  42        .cpu_get_freq = omap_pm_cpu_get_freq,
  43#endif
  44        .dsp_prm_read = omap2_prm_read_mod_reg,
  45        .dsp_prm_write = omap2_prm_write_mod_reg,
  46        .dsp_prm_rmw_bits = omap2_prm_rmw_mod_reg_bits,
  47        .dsp_cm_read = omap2_cm_read_mod_reg,
  48        .dsp_cm_write = omap2_cm_write_mod_reg,
  49        .dsp_cm_rmw_bits = omap2_cm_rmw_mod_reg_bits,
  50
  51        .set_bootaddr = omap_ctrl_write_dsp_boot_addr,
  52        .set_bootmode = omap_ctrl_write_dsp_boot_mode,
  53};
  54
  55static phys_addr_t omap_dsp_phys_mempool_base;
  56
  57void __init omap_dsp_reserve_sdram_memblock(void)
  58{
  59        phys_addr_t size = CONFIG_TIDSPBRIDGE_MEMPOOL_SIZE;
  60        phys_addr_t paddr;
  61
  62        if (!size)
  63                return;
  64
  65        paddr = arm_memblock_steal(size, SZ_1M);
  66        if (!paddr) {
  67                pr_err("%s: failed to reserve %llx bytes\n",
  68                                __func__, (unsigned long long)size);
  69                return;
  70        }
  71
  72        omap_dsp_phys_mempool_base = paddr;
  73}
  74
  75static phys_addr_t omap_dsp_get_mempool_base(void)
  76{
  77        return omap_dsp_phys_mempool_base;
  78}
  79
  80static int __init omap_dsp_init(void)
  81{
  82        struct platform_device *pdev;
  83        int err = -ENOMEM;
  84        struct omap_dsp_platform_data *pdata = &omap_dsp_pdata;
  85
  86        pdata->phys_mempool_base = omap_dsp_get_mempool_base();
  87
  88        if (pdata->phys_mempool_base) {
  89                pdata->phys_mempool_size = CONFIG_TIDSPBRIDGE_MEMPOOL_SIZE;
  90                pr_info("%s: %llx bytes @ %llx\n", __func__,
  91                        (unsigned long long)pdata->phys_mempool_size,
  92                        (unsigned long long)pdata->phys_mempool_base);
  93        }
  94
  95        pdev = platform_device_alloc("omap-dsp", -1);
  96        if (!pdev)
  97                goto err_out;
  98
  99        err = platform_device_add_data(pdev, pdata, sizeof(*pdata));
 100        if (err)
 101                goto err_out;
 102
 103        err = platform_device_add(pdev);
 104        if (err)
 105                goto err_out;
 106
 107        omap_dsp_pdev = pdev;
 108        return 0;
 109
 110err_out:
 111        platform_device_put(pdev);
 112        return err;
 113}
 114module_init(omap_dsp_init);
 115
 116static void __exit omap_dsp_exit(void)
 117{
 118        platform_device_unregister(omap_dsp_pdev);
 119}
 120module_exit(omap_dsp_exit);
 121
 122MODULE_AUTHOR("Hiroshi DOYU");
 123MODULE_DESCRIPTION("TI's OMAP DSP platform device registration");
 124MODULE_LICENSE("GPL");
 125