Version:  2.0.40 2.2.26 2.4.37 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18

Linux/sound/soc/tegra/tegra20_das.c

  1 /*
  2  * tegra20_das.c - Tegra20 DAS driver
  3  *
  4  * Author: Stephen Warren <swarren@nvidia.com>
  5  * Copyright (C) 2010 - NVIDIA, Inc.
  6  *
  7  * This program is free software; you can redistribute it and/or
  8  * modify it under the terms of the GNU General Public License
  9  * version 2 as published by the Free Software Foundation.
 10  *
 11  * This program is distributed in the hope that it will be useful, but
 12  * WITHOUT ANY WARRANTY; without even the implied warranty of
 13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 14  * General Public License for more details.
 15  *
 16  * You should have received a copy of the GNU General Public License
 17  * along with this program; if not, write to the Free Software
 18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 19  * 02110-1301 USA
 20  *
 21  */
 22 
 23 #include <linux/device.h>
 24 #include <linux/io.h>
 25 #include <linux/module.h>
 26 #include <linux/platform_device.h>
 27 #include <linux/regmap.h>
 28 #include <linux/slab.h>
 29 #include <sound/soc.h>
 30 #include "tegra20_das.h"
 31 
 32 #define DRV_NAME "tegra20-das"
 33 
 34 static struct tegra20_das *das;
 35 
 36 static inline void tegra20_das_write(u32 reg, u32 val)
 37 {
 38         regmap_write(das->regmap, reg, val);
 39 }
 40 
 41 static inline u32 tegra20_das_read(u32 reg)
 42 {
 43         u32 val;
 44         regmap_read(das->regmap, reg, &val);
 45         return val;
 46 }
 47 
 48 int tegra20_das_connect_dap_to_dac(int dap, int dac)
 49 {
 50         u32 addr;
 51         u32 reg;
 52 
 53         if (!das)
 54                 return -ENODEV;
 55 
 56         addr = TEGRA20_DAS_DAP_CTRL_SEL +
 57                 (dap * TEGRA20_DAS_DAP_CTRL_SEL_STRIDE);
 58         reg = dac << TEGRA20_DAS_DAP_CTRL_SEL_DAP_CTRL_SEL_P;
 59 
 60         tegra20_das_write(addr, reg);
 61 
 62         return 0;
 63 }
 64 EXPORT_SYMBOL_GPL(tegra20_das_connect_dap_to_dac);
 65 
 66 int tegra20_das_connect_dap_to_dap(int dap, int otherdap, int master,
 67                                    int sdata1rx, int sdata2rx)
 68 {
 69         u32 addr;
 70         u32 reg;
 71 
 72         if (!das)
 73                 return -ENODEV;
 74 
 75         addr = TEGRA20_DAS_DAP_CTRL_SEL +
 76                 (dap * TEGRA20_DAS_DAP_CTRL_SEL_STRIDE);
 77         reg = otherdap << TEGRA20_DAS_DAP_CTRL_SEL_DAP_CTRL_SEL_P |
 78                 !!sdata2rx << TEGRA20_DAS_DAP_CTRL_SEL_DAP_SDATA2_TX_RX_P |
 79                 !!sdata1rx << TEGRA20_DAS_DAP_CTRL_SEL_DAP_SDATA1_TX_RX_P |
 80                 !!master << TEGRA20_DAS_DAP_CTRL_SEL_DAP_MS_SEL_P;
 81 
 82         tegra20_das_write(addr, reg);
 83 
 84         return 0;
 85 }
 86 EXPORT_SYMBOL_GPL(tegra20_das_connect_dap_to_dap);
 87 
 88 int tegra20_das_connect_dac_to_dap(int dac, int dap)
 89 {
 90         u32 addr;
 91         u32 reg;
 92 
 93         if (!das)
 94                 return -ENODEV;
 95 
 96         addr = TEGRA20_DAS_DAC_INPUT_DATA_CLK_SEL +
 97                 (dac * TEGRA20_DAS_DAC_INPUT_DATA_CLK_SEL_STRIDE);
 98         reg = dap << TEGRA20_DAS_DAC_INPUT_DATA_CLK_SEL_DAC_CLK_SEL_P |
 99                 dap << TEGRA20_DAS_DAC_INPUT_DATA_CLK_SEL_DAC_SDATA1_SEL_P |
100                 dap << TEGRA20_DAS_DAC_INPUT_DATA_CLK_SEL_DAC_SDATA2_SEL_P;
101 
102         tegra20_das_write(addr, reg);
103 
104         return 0;
105 }
106 EXPORT_SYMBOL_GPL(tegra20_das_connect_dac_to_dap);
107 
108 #define LAST_REG(name) \
109         (TEGRA20_DAS_##name + \
110          (TEGRA20_DAS_##name##_STRIDE * (TEGRA20_DAS_##name##_COUNT - 1)))
111 
112 static bool tegra20_das_wr_rd_reg(struct device *dev, unsigned int reg)
113 {
114         if ((reg >= TEGRA20_DAS_DAP_CTRL_SEL) &&
115             (reg <= LAST_REG(DAP_CTRL_SEL)))
116                 return true;
117         if ((reg >= TEGRA20_DAS_DAC_INPUT_DATA_CLK_SEL) &&
118             (reg <= LAST_REG(DAC_INPUT_DATA_CLK_SEL)))
119                 return true;
120 
121         return false;
122 }
123 
124 static const struct regmap_config tegra20_das_regmap_config = {
125         .reg_bits = 32,
126         .reg_stride = 4,
127         .val_bits = 32,
128         .max_register = LAST_REG(DAC_INPUT_DATA_CLK_SEL),
129         .writeable_reg = tegra20_das_wr_rd_reg,
130         .readable_reg = tegra20_das_wr_rd_reg,
131         .cache_type = REGCACHE_FLAT,
132 };
133 
134 static int tegra20_das_probe(struct platform_device *pdev)
135 {
136         struct resource *res, *region;
137         void __iomem *regs;
138         int ret = 0;
139 
140         if (das)
141                 return -ENODEV;
142 
143         das = devm_kzalloc(&pdev->dev, sizeof(struct tegra20_das), GFP_KERNEL);
144         if (!das) {
145                 dev_err(&pdev->dev, "Can't allocate tegra20_das\n");
146                 ret = -ENOMEM;
147                 goto err;
148         }
149         das->dev = &pdev->dev;
150 
151         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
152         if (!res) {
153                 dev_err(&pdev->dev, "No memory resource\n");
154                 ret = -ENODEV;
155                 goto err;
156         }
157 
158         region = devm_request_mem_region(&pdev->dev, res->start,
159                                          resource_size(res), pdev->name);
160         if (!region) {
161                 dev_err(&pdev->dev, "Memory region already claimed\n");
162                 ret = -EBUSY;
163                 goto err;
164         }
165 
166         regs = devm_ioremap(&pdev->dev, res->start, resource_size(res));
167         if (!regs) {
168                 dev_err(&pdev->dev, "ioremap failed\n");
169                 ret = -ENOMEM;
170                 goto err;
171         }
172 
173         das->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
174                                             &tegra20_das_regmap_config);
175         if (IS_ERR(das->regmap)) {
176                 dev_err(&pdev->dev, "regmap init failed\n");
177                 ret = PTR_ERR(das->regmap);
178                 goto err;
179         }
180 
181         ret = tegra20_das_connect_dap_to_dac(TEGRA20_DAS_DAP_ID_1,
182                                              TEGRA20_DAS_DAP_SEL_DAC1);
183         if (ret) {
184                 dev_err(&pdev->dev, "Can't set up DAS DAP connection\n");
185                 goto err;
186         }
187         ret = tegra20_das_connect_dac_to_dap(TEGRA20_DAS_DAC_ID_1,
188                                              TEGRA20_DAS_DAC_SEL_DAP1);
189         if (ret) {
190                 dev_err(&pdev->dev, "Can't set up DAS DAC connection\n");
191                 goto err;
192         }
193 
194         ret = tegra20_das_connect_dap_to_dac(TEGRA20_DAS_DAP_ID_3,
195                                              TEGRA20_DAS_DAP_SEL_DAC3);
196         if (ret) {
197                 dev_err(&pdev->dev, "Can't set up DAS DAP connection\n");
198                 goto err;
199         }
200         ret = tegra20_das_connect_dac_to_dap(TEGRA20_DAS_DAC_ID_3,
201                                              TEGRA20_DAS_DAC_SEL_DAP3);
202         if (ret) {
203                 dev_err(&pdev->dev, "Can't set up DAS DAC connection\n");
204                 goto err;
205         }
206 
207         platform_set_drvdata(pdev, das);
208 
209         return 0;
210 
211 err:
212         das = NULL;
213         return ret;
214 }
215 
216 static int tegra20_das_remove(struct platform_device *pdev)
217 {
218         if (!das)
219                 return -ENODEV;
220 
221         das = NULL;
222 
223         return 0;
224 }
225 
226 static const struct of_device_id tegra20_das_of_match[] = {
227         { .compatible = "nvidia,tegra20-das", },
228         {},
229 };
230 
231 static struct platform_driver tegra20_das_driver = {
232         .probe = tegra20_das_probe,
233         .remove = tegra20_das_remove,
234         .driver = {
235                 .name = DRV_NAME,
236                 .owner = THIS_MODULE,
237                 .of_match_table = tegra20_das_of_match,
238         },
239 };
240 module_platform_driver(tegra20_das_driver);
241 
242 MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
243 MODULE_DESCRIPTION("Tegra20 DAS driver");
244 MODULE_LICENSE("GPL");
245 MODULE_ALIAS("platform:" DRV_NAME);
246 MODULE_DEVICE_TABLE(of, tegra20_das_of_match);
247 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us