Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 1 | /* |
| 2 | * corgi.c -- SoC audio for Corgi |
| 3 | * |
| 4 | * Copyright 2005 Wolfson Microelectronics PLC. |
| 5 | * Copyright 2005 Openedhand Ltd. |
| 6 | * |
Liam Girdwood | d331124 | 2008-10-12 13:17:36 +0100 | [diff] [blame] | 7 | * Authors: Liam Girdwood <lrg@slimlogic.co.uk> |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 8 | * Richard Purdie <richard@openedhand.com> |
| 9 | * |
| 10 | * This program is free software; you can redistribute it and/or modify it |
| 11 | * under the terms of the GNU General Public License as published by the |
| 12 | * Free Software Foundation; either version 2 of the License, or (at your |
| 13 | * option) any later version. |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 14 | */ |
| 15 | |
| 16 | #include <linux/module.h> |
| 17 | #include <linux/moduleparam.h> |
| 18 | #include <linux/timer.h> |
| 19 | #include <linux/interrupt.h> |
| 20 | #include <linux/platform_device.h> |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 21 | #include <linux/gpio.h> |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 22 | #include <sound/core.h> |
| 23 | #include <sound/pcm.h> |
| 24 | #include <sound/soc.h> |
| 25 | #include <sound/soc-dapm.h> |
| 26 | |
| 27 | #include <asm/mach-types.h> |
Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 28 | #include <mach/pxa-regs.h> |
| 29 | #include <mach/hardware.h> |
| 30 | #include <mach/corgi.h> |
| 31 | #include <mach/audio.h> |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 32 | |
| 33 | #include "../codecs/wm8731.h" |
| 34 | #include "pxa2xx-pcm.h" |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 35 | #include "pxa2xx-i2s.h" |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 36 | |
| 37 | #define CORGI_HP 0 |
| 38 | #define CORGI_MIC 1 |
| 39 | #define CORGI_LINE 2 |
| 40 | #define CORGI_HEADSET 3 |
| 41 | #define CORGI_HP_OFF 4 |
| 42 | #define CORGI_SPK_ON 0 |
| 43 | #define CORGI_SPK_OFF 1 |
| 44 | |
| 45 | /* audio clock in Hz - rounded from 12.235MHz */ |
| 46 | #define CORGI_AUDIO_CLOCK 12288000 |
| 47 | |
| 48 | static int corgi_jack_func; |
| 49 | static int corgi_spk_func; |
| 50 | |
| 51 | static void corgi_ext_control(struct snd_soc_codec *codec) |
| 52 | { |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 53 | /* set up jack connection */ |
| 54 | switch (corgi_jack_func) { |
| 55 | case CORGI_HP: |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 56 | /* set = unmute headphone */ |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 57 | gpio_set_value(CORGI_GPIO_MUTE_L, 1); |
| 58 | gpio_set_value(CORGI_GPIO_MUTE_R, 1); |
Liam Girdwood | a530218 | 2008-07-07 13:35:17 +0100 | [diff] [blame] | 59 | snd_soc_dapm_disable_pin(codec, "Mic Jack"); |
| 60 | snd_soc_dapm_disable_pin(codec, "Line Jack"); |
| 61 | snd_soc_dapm_enable_pin(codec, "Headphone Jack"); |
| 62 | snd_soc_dapm_disable_pin(codec, "Headset Jack"); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 63 | break; |
| 64 | case CORGI_MIC: |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 65 | /* reset = mute headphone */ |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 66 | gpio_set_value(CORGI_GPIO_MUTE_L, 0); |
| 67 | gpio_set_value(CORGI_GPIO_MUTE_R, 0); |
Liam Girdwood | a530218 | 2008-07-07 13:35:17 +0100 | [diff] [blame] | 68 | snd_soc_dapm_enable_pin(codec, "Mic Jack"); |
| 69 | snd_soc_dapm_disable_pin(codec, "Line Jack"); |
| 70 | snd_soc_dapm_disable_pin(codec, "Headphone Jack"); |
| 71 | snd_soc_dapm_disable_pin(codec, "Headset Jack"); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 72 | break; |
| 73 | case CORGI_LINE: |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 74 | gpio_set_value(CORGI_GPIO_MUTE_L, 0); |
| 75 | gpio_set_value(CORGI_GPIO_MUTE_R, 0); |
Liam Girdwood | a530218 | 2008-07-07 13:35:17 +0100 | [diff] [blame] | 76 | snd_soc_dapm_disable_pin(codec, "Mic Jack"); |
| 77 | snd_soc_dapm_enable_pin(codec, "Line Jack"); |
| 78 | snd_soc_dapm_disable_pin(codec, "Headphone Jack"); |
| 79 | snd_soc_dapm_disable_pin(codec, "Headset Jack"); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 80 | break; |
| 81 | case CORGI_HEADSET: |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 82 | gpio_set_value(CORGI_GPIO_MUTE_L, 0); |
| 83 | gpio_set_value(CORGI_GPIO_MUTE_R, 1); |
Liam Girdwood | a530218 | 2008-07-07 13:35:17 +0100 | [diff] [blame] | 84 | snd_soc_dapm_enable_pin(codec, "Mic Jack"); |
| 85 | snd_soc_dapm_disable_pin(codec, "Line Jack"); |
| 86 | snd_soc_dapm_disable_pin(codec, "Headphone Jack"); |
| 87 | snd_soc_dapm_enable_pin(codec, "Headset Jack"); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 88 | break; |
| 89 | } |
| 90 | |
| 91 | if (corgi_spk_func == CORGI_SPK_ON) |
Liam Girdwood | a530218 | 2008-07-07 13:35:17 +0100 | [diff] [blame] | 92 | snd_soc_dapm_enable_pin(codec, "Ext Spk"); |
| 93 | else |
| 94 | snd_soc_dapm_disable_pin(codec, "Ext Spk"); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 95 | |
| 96 | /* signal a DAPM event */ |
Liam Girdwood | a530218 | 2008-07-07 13:35:17 +0100 | [diff] [blame] | 97 | snd_soc_dapm_sync(codec); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 98 | } |
| 99 | |
| 100 | static int corgi_startup(struct snd_pcm_substream *substream) |
| 101 | { |
| 102 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| 103 | struct snd_soc_codec *codec = rtd->socdev->codec; |
| 104 | |
| 105 | /* check the jack status at stream startup */ |
| 106 | corgi_ext_control(codec); |
| 107 | return 0; |
| 108 | } |
| 109 | |
| 110 | /* we need to unmute the HP at shutdown as the mute burns power on corgi */ |
| 111 | static int corgi_shutdown(struct snd_pcm_substream *substream) |
| 112 | { |
| 113 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| 114 | struct snd_soc_codec *codec = rtd->socdev->codec; |
| 115 | |
| 116 | /* set = unmute headphone */ |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 117 | gpio_set_value(CORGI_GPIO_MUTE_L, 1); |
| 118 | gpio_set_value(CORGI_GPIO_MUTE_R, 1); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 119 | return 0; |
| 120 | } |
| 121 | |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 122 | static int corgi_hw_params(struct snd_pcm_substream *substream, |
| 123 | struct snd_pcm_hw_params *params) |
| 124 | { |
| 125 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | 917f93a | 2008-07-07 16:08:11 +0100 | [diff] [blame] | 126 | struct snd_soc_dai *codec_dai = rtd->dai->codec_dai; |
| 127 | struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai; |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 128 | unsigned int clk = 0; |
| 129 | int ret = 0; |
| 130 | |
| 131 | switch (params_rate(params)) { |
| 132 | case 8000: |
| 133 | case 16000: |
| 134 | case 48000: |
| 135 | case 96000: |
| 136 | clk = 12288000; |
| 137 | break; |
| 138 | case 11025: |
| 139 | case 22050: |
| 140 | case 44100: |
| 141 | clk = 11289600; |
| 142 | break; |
| 143 | } |
| 144 | |
| 145 | /* set codec DAI configuration */ |
Liam Girdwood | 64105cf | 2008-07-08 13:19:18 +0100 | [diff] [blame] | 146 | ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S | |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 147 | SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS); |
| 148 | if (ret < 0) |
| 149 | return ret; |
| 150 | |
| 151 | /* set cpu DAI configuration */ |
Liam Girdwood | 64105cf | 2008-07-08 13:19:18 +0100 | [diff] [blame] | 152 | ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S | |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 153 | SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS); |
| 154 | if (ret < 0) |
| 155 | return ret; |
| 156 | |
| 157 | /* set the codec system clock for DAC and ADC */ |
Liam Girdwood | 64105cf | 2008-07-08 13:19:18 +0100 | [diff] [blame] | 158 | ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK, clk, |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 159 | SND_SOC_CLOCK_IN); |
| 160 | if (ret < 0) |
| 161 | return ret; |
| 162 | |
| 163 | /* set the I2S system clock as input (unused) */ |
Liam Girdwood | 64105cf | 2008-07-08 13:19:18 +0100 | [diff] [blame] | 164 | ret = snd_soc_dai_set_sysclk(cpu_dai, PXA2XX_I2S_SYSCLK, 0, |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 165 | SND_SOC_CLOCK_IN); |
| 166 | if (ret < 0) |
| 167 | return ret; |
| 168 | |
| 169 | return 0; |
| 170 | } |
| 171 | |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 172 | static struct snd_soc_ops corgi_ops = { |
| 173 | .startup = corgi_startup, |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 174 | .hw_params = corgi_hw_params, |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 175 | .shutdown = corgi_shutdown, |
| 176 | }; |
| 177 | |
| 178 | static int corgi_get_jack(struct snd_kcontrol *kcontrol, |
| 179 | struct snd_ctl_elem_value *ucontrol) |
| 180 | { |
| 181 | ucontrol->value.integer.value[0] = corgi_jack_func; |
| 182 | return 0; |
| 183 | } |
| 184 | |
| 185 | static int corgi_set_jack(struct snd_kcontrol *kcontrol, |
| 186 | struct snd_ctl_elem_value *ucontrol) |
| 187 | { |
| 188 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); |
| 189 | |
| 190 | if (corgi_jack_func == ucontrol->value.integer.value[0]) |
| 191 | return 0; |
| 192 | |
| 193 | corgi_jack_func = ucontrol->value.integer.value[0]; |
| 194 | corgi_ext_control(codec); |
| 195 | return 1; |
| 196 | } |
| 197 | |
| 198 | static int corgi_get_spk(struct snd_kcontrol *kcontrol, |
| 199 | struct snd_ctl_elem_value *ucontrol) |
| 200 | { |
| 201 | ucontrol->value.integer.value[0] = corgi_spk_func; |
| 202 | return 0; |
| 203 | } |
| 204 | |
| 205 | static int corgi_set_spk(struct snd_kcontrol *kcontrol, |
| 206 | struct snd_ctl_elem_value *ucontrol) |
| 207 | { |
| 208 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); |
| 209 | |
| 210 | if (corgi_spk_func == ucontrol->value.integer.value[0]) |
| 211 | return 0; |
| 212 | |
| 213 | corgi_spk_func = ucontrol->value.integer.value[0]; |
| 214 | corgi_ext_control(codec); |
| 215 | return 1; |
| 216 | } |
| 217 | |
Jarkko Nikula | 338c7ed | 2008-02-28 12:34:48 +0100 | [diff] [blame] | 218 | static int corgi_amp_event(struct snd_soc_dapm_widget *w, |
| 219 | struct snd_kcontrol *k, int event) |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 220 | { |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 221 | gpio_set_value(CORGI_GPIO_APM_ON, SND_SOC_DAPM_EVENT_ON(event)); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 222 | return 0; |
| 223 | } |
| 224 | |
Jarkko Nikula | 338c7ed | 2008-02-28 12:34:48 +0100 | [diff] [blame] | 225 | static int corgi_mic_event(struct snd_soc_dapm_widget *w, |
| 226 | struct snd_kcontrol *k, int event) |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 227 | { |
Eric Miao | 6168cda | 2008-09-05 18:15:22 +0800 | [diff] [blame] | 228 | gpio_set_value(CORGI_GPIO_MIC_BIAS, SND_SOC_DAPM_EVENT_ON(event)); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 229 | return 0; |
| 230 | } |
| 231 | |
| 232 | /* corgi machine dapm widgets */ |
| 233 | static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = { |
| 234 | SND_SOC_DAPM_HP("Headphone Jack", NULL), |
| 235 | SND_SOC_DAPM_MIC("Mic Jack", corgi_mic_event), |
| 236 | SND_SOC_DAPM_SPK("Ext Spk", corgi_amp_event), |
| 237 | SND_SOC_DAPM_LINE("Line Jack", NULL), |
| 238 | SND_SOC_DAPM_HP("Headset Jack", NULL), |
| 239 | }; |
| 240 | |
| 241 | /* Corgi machine audio map (connections to the codec pins) */ |
Mark Brown | 25191c4 | 2008-05-13 14:55:48 +0200 | [diff] [blame] | 242 | static const struct snd_soc_dapm_route audio_map[] = { |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 243 | |
| 244 | /* headset Jack - in = micin, out = LHPOUT*/ |
| 245 | {"Headset Jack", NULL, "LHPOUT"}, |
| 246 | |
| 247 | /* headphone connected to LHPOUT1, RHPOUT1 */ |
| 248 | {"Headphone Jack", NULL, "LHPOUT"}, |
| 249 | {"Headphone Jack", NULL, "RHPOUT"}, |
| 250 | |
| 251 | /* speaker connected to LOUT, ROUT */ |
| 252 | {"Ext Spk", NULL, "ROUT"}, |
| 253 | {"Ext Spk", NULL, "LOUT"}, |
| 254 | |
| 255 | /* mic is connected to MICIN (via right channel of headphone jack) */ |
| 256 | {"MICIN", NULL, "Mic Jack"}, |
| 257 | |
| 258 | /* Same as the above but no mic bias for line signals */ |
| 259 | {"MICIN", NULL, "Line Jack"}, |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 260 | }; |
| 261 | |
| 262 | static const char *jack_function[] = {"Headphone", "Mic", "Line", "Headset", |
| 263 | "Off"}; |
| 264 | static const char *spk_function[] = {"On", "Off"}; |
| 265 | static const struct soc_enum corgi_enum[] = { |
| 266 | SOC_ENUM_SINGLE_EXT(5, jack_function), |
| 267 | SOC_ENUM_SINGLE_EXT(2, spk_function), |
| 268 | }; |
| 269 | |
| 270 | static const struct snd_kcontrol_new wm8731_corgi_controls[] = { |
| 271 | SOC_ENUM_EXT("Jack Function", corgi_enum[0], corgi_get_jack, |
| 272 | corgi_set_jack), |
| 273 | SOC_ENUM_EXT("Speaker Function", corgi_enum[1], corgi_get_spk, |
| 274 | corgi_set_spk), |
| 275 | }; |
| 276 | |
| 277 | /* |
| 278 | * Logic for a wm8731 as connected on a Sharp SL-C7x0 Device |
| 279 | */ |
| 280 | static int corgi_wm8731_init(struct snd_soc_codec *codec) |
| 281 | { |
| 282 | int i, err; |
| 283 | |
Mark Brown | 35f5e54 | 2008-09-27 10:45:09 +0100 | [diff] [blame] | 284 | snd_soc_dapm_nc_pin(codec, "LLINEIN"); |
| 285 | snd_soc_dapm_nc_pin(codec, "RLINEIN"); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 286 | |
| 287 | /* Add corgi specific controls */ |
| 288 | for (i = 0; i < ARRAY_SIZE(wm8731_corgi_controls); i++) { |
| 289 | err = snd_ctl_add(codec->card, |
Mark Brown | 1bfcd36 | 2008-04-23 15:12:19 +0200 | [diff] [blame] | 290 | snd_soc_cnew(&wm8731_corgi_controls[i], codec, NULL)); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 291 | if (err < 0) |
| 292 | return err; |
| 293 | } |
| 294 | |
| 295 | /* Add corgi specific widgets */ |
Mark Brown | 25191c4 | 2008-05-13 14:55:48 +0200 | [diff] [blame] | 296 | snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets, |
| 297 | ARRAY_SIZE(wm8731_dapm_widgets)); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 298 | |
| 299 | /* Set up corgi specific audio path audio_map */ |
Mark Brown | 25191c4 | 2008-05-13 14:55:48 +0200 | [diff] [blame] | 300 | snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map)); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 301 | |
Liam Girdwood | a530218 | 2008-07-07 13:35:17 +0100 | [diff] [blame] | 302 | snd_soc_dapm_sync(codec); |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 303 | return 0; |
| 304 | } |
| 305 | |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 306 | /* corgi digital audio interface glue - connects codec <--> CPU */ |
| 307 | static struct snd_soc_dai_link corgi_dai = { |
| 308 | .name = "WM8731", |
| 309 | .stream_name = "WM8731", |
| 310 | .cpu_dai = &pxa_i2s_dai, |
| 311 | .codec_dai = &wm8731_dai, |
| 312 | .init = corgi_wm8731_init, |
Liam Girdwood | d928b25 | 2007-02-02 17:22:20 +0100 | [diff] [blame] | 313 | .ops = &corgi_ops, |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 314 | }; |
| 315 | |
| 316 | /* corgi audio machine driver */ |
| 317 | static struct snd_soc_machine snd_soc_machine_corgi = { |
| 318 | .name = "Corgi", |
| 319 | .dai_link = &corgi_dai, |
| 320 | .num_links = 1, |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 321 | }; |
| 322 | |
| 323 | /* corgi audio private data */ |
| 324 | static struct wm8731_setup_data corgi_wm8731_setup = { |
Jean Delvare | 81297c8 | 2008-09-01 18:47:01 +0100 | [diff] [blame] | 325 | .i2c_bus = 0, |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 326 | .i2c_address = 0x1b, |
| 327 | }; |
| 328 | |
| 329 | /* corgi audio subsystem */ |
| 330 | static struct snd_soc_device corgi_snd_devdata = { |
| 331 | .machine = &snd_soc_machine_corgi, |
| 332 | .platform = &pxa2xx_soc_platform, |
| 333 | .codec_dev = &soc_codec_dev_wm8731, |
| 334 | .codec_data = &corgi_wm8731_setup, |
| 335 | }; |
| 336 | |
| 337 | static struct platform_device *corgi_snd_device; |
| 338 | |
| 339 | static int __init corgi_init(void) |
| 340 | { |
| 341 | int ret; |
| 342 | |
Mark Brown | 1bfcd36 | 2008-04-23 15:12:19 +0200 | [diff] [blame] | 343 | if (!(machine_is_corgi() || machine_is_shepherd() || |
| 344 | machine_is_husky())) |
Liam Girdwood | a1eb4b3 | 2006-10-12 14:31:16 +0200 | [diff] [blame] | 345 | return -ENODEV; |
| 346 | |
| 347 | corgi_snd_device = platform_device_alloc("soc-audio", -1); |
| 348 | if (!corgi_snd_device) |
| 349 | return -ENOMEM; |
| 350 | |
| 351 | platform_set_drvdata(corgi_snd_device, &corgi_snd_devdata); |
| 352 | corgi_snd_devdata.dev = &corgi_snd_device->dev; |
| 353 | ret = platform_device_add(corgi_snd_device); |
| 354 | |
| 355 | if (ret) |
| 356 | platform_device_put(corgi_snd_device); |
| 357 | |
| 358 | return ret; |
| 359 | } |
| 360 | |
| 361 | static void __exit corgi_exit(void) |
| 362 | { |
| 363 | platform_device_unregister(corgi_snd_device); |
| 364 | } |
| 365 | |
| 366 | module_init(corgi_init); |
| 367 | module_exit(corgi_exit); |
| 368 | |
| 369 | /* Module information */ |
| 370 | MODULE_AUTHOR("Richard Purdie"); |
| 371 | MODULE_DESCRIPTION("ALSA SoC Corgi"); |
| 372 | MODULE_LICENSE("GPL"); |