Blame view

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