arch/arm/plat-s3c24xx/simtec-audio.c

   1 /* linux/arch/arm/plat-s3c24xx/simtec-audio.c
   2  *
   3  * Copyright (c) 2009 Simtec Electronics
   4  *      http://armlinux.simtec.co.uk/
   5  *      Ben Dooks <ben@simtec.co.uk>
   6  *
   7  * Audio setup for various Simtec S3C24XX implementations
   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 #include <linux/kernel.h>
  15 #include <linux/interrupt.h>
  16 #include <linux/init.h>
  17 #include <linux/device.h>
  18 #include <linux/io.h>
  19
  20 #include <mach/bast-map.h>
  21 #include <mach/bast-irq.h>
  22 #include <mach/bast-cpld.h>
  23
  24 #include <mach/hardware.h>
  25 #include <mach/regs-gpio.h>
  26
  27 #include <plat/audio-simtec.h>
  28 #include <plat/devs.h>
  29
  30 /* platform ops for audio */
  31
  32 static void simtec_audio_startup_lrroute(void)
  33 {
  34         unsigned int tmp;
  35         unsigned long flags;
  36
  37         local_irq_save(flags);
  38
  39         tmp = __raw_readb(BAST_VA_CTRL1);
  40         tmp &= ~BAST_CPLD_CTRL1_LRMASK;
  41         tmp |= BAST_CPLD_CTRL1_LRCDAC;
  42         __raw_writeb(tmp, BAST_VA_CTRL1);
  43
  44         local_irq_restore(flags);
  45 }
  46
  47 static struct s3c24xx_audio_simtec_pdata simtec_audio_platdata;
  48 static char our_name[32];
  49
  50 static struct platform_device simtec_audio_dev = {
  51         .name   = our_name,
  52         .id     = -1,
  53         .dev    = {
  54                 .parent         = &s3c_device_iis.dev,
  55                 .platform_data  = &simtec_audio_platdata,
  56         },
  57 };
  58
  59 int __init simtec_audio_add(const char *name, bool has_lr_routing,
  60                             struct s3c24xx_audio_simtec_pdata *spd)
  61 {
  62         if (!name)
  63                 name = "tlv320aic23";
  64
  65         snprintf(our_name, sizeof(our_name)-1, "s3c24xx-simtec-%s", name);
  66
  67         /* copy platform data so the source can be __initdata */
  68         if (spd)
  69                 simtec_audio_platdata = *spd;
  70
  71         if (has_lr_routing)
  72                 simtec_audio_platdata.startup = simtec_audio_startup_lrroute;
  73
  74         platform_device_register(&s3c_device_iis);
  75         platform_device_register(&simtec_audio_dev);
  76         return 0;
  77 }