Pull platform-drivers into test branch
[linux-2.6] / arch / arm / mach-s3c2410 / s3c2440-dsc.c
1 /* linux/arch/arm/mach-s3c2410/s3c2440-dsc.c
2  *
3  * Copyright (c) 2004-2005 Simtec Electronics
4  *   Ben Dooks <ben@simtec.co.uk>
5  *
6  * Samsung S3C2440 Drive Strength Control support
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11 */
12
13 #include <linux/kernel.h>
14 #include <linux/types.h>
15 #include <linux/interrupt.h>
16 #include <linux/init.h>
17 #include <linux/module.h>
18
19 #include <asm/mach/arch.h>
20 #include <asm/mach/map.h>
21 #include <asm/mach/irq.h>
22
23 #include <asm/hardware.h>
24 #include <asm/io.h>
25 #include <asm/irq.h>
26
27 #include <asm/arch/regs-gpio.h>
28 #include <asm/arch/regs-dsc.h>
29
30 #include "cpu.h"
31 #include "s3c2440.h"
32
33 int s3c2440_set_dsc(unsigned int pin, unsigned int value)
34 {
35         void __iomem *base;
36         unsigned long val;
37         unsigned long flags;
38         unsigned long mask;
39
40         base = (pin & S3C2440_SELECT_DSC1) ? S3C2440_DSC1 : S3C2440_DSC0;
41         mask = 3 << S3C2440_DSC_GETSHIFT(pin);
42
43         local_irq_save(flags);
44
45         val = __raw_readl(base);
46         val &= ~mask;
47         val |= value & mask;
48         __raw_writel(val, base);
49
50         local_irq_restore(flags);
51         return 0;
52 }
53
54 EXPORT_SYMBOL(s3c2440_set_dsc);