2 * linux/arch/arm/mach-omap2/mcbsp.c
4 * Copyright (C) 2008 Instituto Nokia de Tecnologia
5 * Contact: Eduardo Valentin <eduardo.valentin@indt.org.br>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * Multichannel mode not supported.
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/clk.h>
16 #include <linux/err.h>
18 #include <linux/platform_device.h>
19 #include <linux/slab.h>
21 #include <mach/irqs.h>
24 #include <plat/mcbsp.h>
25 #include <plat/omap_device.h>
29 /* McBSP internal signal muxing functions */
31 void omap2_mcbsp1_mux_clkr_src(u8 mux)
35 v = omap_ctrl_readl(OMAP2_CONTROL_DEVCONF0);
36 if (mux == CLKR_SRC_CLKR)
37 v &= ~OMAP2_MCBSP1_CLKR_MASK;
38 else if (mux == CLKR_SRC_CLKX)
39 v |= OMAP2_MCBSP1_CLKR_MASK;
40 omap_ctrl_writel(v, OMAP2_CONTROL_DEVCONF0);
42 EXPORT_SYMBOL(omap2_mcbsp1_mux_clkr_src);
44 void omap2_mcbsp1_mux_fsr_src(u8 mux)
48 v = omap_ctrl_readl(OMAP2_CONTROL_DEVCONF0);
49 if (mux == FSR_SRC_FSR)
50 v &= ~OMAP2_MCBSP1_FSR_MASK;
51 else if (mux == FSR_SRC_FSX)
52 v |= OMAP2_MCBSP1_FSR_MASK;
53 omap_ctrl_writel(v, OMAP2_CONTROL_DEVCONF0);
55 EXPORT_SYMBOL(omap2_mcbsp1_mux_fsr_src);
57 /* McBSP CLKS source switching function */
59 int omap2_mcbsp_set_clks_src(u8 id, u8 fck_src_id)
61 struct omap_mcbsp *mcbsp;
66 if (!omap_mcbsp_check_valid_id(id)) {
67 pr_err("%s: Invalid id (%d)\n", __func__, id + 1);
70 mcbsp = id_to_mcbsp_ptr(id);
72 if (fck_src_id == MCBSP_CLKS_PAD_SRC)
73 fck_src_name = "pad_fck";
74 else if (fck_src_id == MCBSP_CLKS_PRCM_SRC)
75 fck_src_name = "prcm_fck";
79 fck_src = clk_get(mcbsp->dev, fck_src_name);
80 if (IS_ERR_OR_NULL(fck_src)) {
81 pr_err("omap-mcbsp: %s: could not clk_get() %s\n", "clks",
86 clk_disable(mcbsp->fclk);
88 r = clk_set_parent(mcbsp->fclk, fck_src);
89 if (IS_ERR_VALUE(r)) {
90 pr_err("omap-mcbsp: %s: could not clk_set_parent() to %s\n",
91 "clks", fck_src_name);
96 clk_enable(mcbsp->fclk);
102 EXPORT_SYMBOL(omap2_mcbsp_set_clks_src);
104 struct omap_device_pm_latency omap2_mcbsp_latency[] = {
106 .deactivate_func = omap_device_idle_hwmods,
107 .activate_func = omap_device_enable_hwmods,
108 .flags = OMAP_DEVICE_LATENCY_AUTO_ADJUST,
112 static int omap_init_mcbsp(struct omap_hwmod *oh, void *unused)
115 char *name = "omap-mcbsp";
116 struct omap_hwmod *oh_device[2];
117 struct omap_mcbsp_platform_data *pdata = NULL;
118 struct omap_device *od;
120 sscanf(oh->name, "mcbsp%d", &id);
122 pdata = kzalloc(sizeof(struct omap_mcbsp_platform_data), GFP_KERNEL);
124 pr_err("%s: No memory for mcbsp\n", __func__);
128 if (oh->class->rev == MCBSP_CONFIG_TYPE3) {
130 /* The FIFO has 1024 + 256 locations */
131 pdata->buffer_size = 0x500;
133 /* The FIFO has 128 locations */
134 pdata->buffer_size = 0x80;
140 oh_device[1] = omap_hwmod_lookup((
141 (struct omap_mcbsp_dev_attr *)(oh->dev_attr))->sidetone);
144 od = omap_device_build_ss(name, id, oh_device, count, pdata,
145 sizeof(*pdata), omap2_mcbsp_latency,
146 ARRAY_SIZE(omap2_mcbsp_latency), false);
149 pr_err("%s: Cant build omap_device for %s:%s.\n", __func__,
157 static int __init omap2_mcbsp_init(void)
159 omap_hwmod_for_each_by_class("mcbsp", omap_init_mcbsp, NULL);
161 mcbsp_ptr = kzalloc(omap_mcbsp_count * sizeof(struct omap_mcbsp *),
166 return omap_mcbsp_init();
168 arch_initcall(omap2_mcbsp_init);