diff options
| author | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
|---|---|---|
| committer | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
| commit | fcc9d2e5a6c89d22b8b773a64fb4ad21ac318446 (patch) | |
| tree | a57612d1888735a2ec7972891b68c1ac5ec8faea /arch/unicore32 | |
| parent | 8dea78da5cee153b8af9c07a2745f6c55057fe12 (diff) | |
Diffstat (limited to 'arch/unicore32')
| -rw-r--r-- | arch/unicore32/include/asm/byteorder.h | 24 | ||||
| -rw-r--r-- | arch/unicore32/include/asm/sigcontext.h | 29 | ||||
| -rw-r--r-- | arch/unicore32/include/asm/system.h | 161 | ||||
| -rw-r--r-- | arch/unicore32/include/asm/unistd.h | 18 | ||||
| -rw-r--r-- | arch/unicore32/kernel/init_task.c | 44 | ||||
| -rw-r--r-- | arch/unicore32/kernel/pwm.c | 263 |
6 files changed, 539 insertions, 0 deletions
diff --git a/arch/unicore32/include/asm/byteorder.h b/arch/unicore32/include/asm/byteorder.h new file mode 100644 index 00000000000..ebe1b3fef3e --- /dev/null +++ b/arch/unicore32/include/asm/byteorder.h | |||
| @@ -0,0 +1,24 @@ | |||
| 1 | /* | ||
| 2 | * linux/arch/unicore32/include/asm/byteorder.h | ||
| 3 | * | ||
| 4 | * Code specific to PKUnity SoC and UniCore ISA | ||
| 5 | * | ||
| 6 | * Copyright (C) 2001-2010 GUAN Xue-tao | ||
| 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 | * UniCore ONLY support Little Endian mode, the data bus is connected such | ||
| 13 | * that byte accesses appear as: | ||
| 14 | * 0 = d0...d7, 1 = d8...d15, 2 = d16...d23, 3 = d24...d31 | ||
| 15 | * and word accesses (data or instruction) appear as: | ||
| 16 | * d0...d31 | ||
| 17 | */ | ||
| 18 | #ifndef __UNICORE_BYTEORDER_H__ | ||
| 19 | #define __UNICORE_BYTEORDER_H__ | ||
| 20 | |||
| 21 | #include <linux/byteorder/little_endian.h> | ||
| 22 | |||
| 23 | #endif | ||
| 24 | |||
diff --git a/arch/unicore32/include/asm/sigcontext.h b/arch/unicore32/include/asm/sigcontext.h new file mode 100644 index 00000000000..6a2d7671c05 --- /dev/null +++ b/arch/unicore32/include/asm/sigcontext.h | |||
| @@ -0,0 +1,29 @@ | |||
| 1 | /* | ||
| 2 | * linux/arch/unicore32/include/asm/sigcontext.h | ||
| 3 | * | ||
| 4 | * Code specific to PKUnity SoC and UniCore ISA | ||
| 5 | * | ||
| 6 | * Copyright (C) 2001-2010 GUAN Xue-tao | ||
| 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 | #ifndef __UNICORE_SIGCONTEXT_H__ | ||
| 13 | #define __UNICORE_SIGCONTEXT_H__ | ||
| 14 | |||
| 15 | #include <asm/ptrace.h> | ||
| 16 | /* | ||
| 17 | * Signal context structure - contains all info to do with the state | ||
| 18 | * before the signal handler was invoked. Note: only add new entries | ||
| 19 | * to the end of the structure. | ||
| 20 | */ | ||
| 21 | struct sigcontext { | ||
| 22 | unsigned long trap_no; | ||
| 23 | unsigned long error_code; | ||
| 24 | unsigned long oldmask; | ||
| 25 | unsigned long fault_address; | ||
| 26 | struct pt_regs regs; | ||
| 27 | }; | ||
| 28 | |||
| 29 | #endif | ||
diff --git a/arch/unicore32/include/asm/system.h b/arch/unicore32/include/asm/system.h new file mode 100644 index 00000000000..246b71c17fd --- /dev/null +++ b/arch/unicore32/include/asm/system.h | |||
| @@ -0,0 +1,161 @@ | |||
| 1 | /* | ||
| 2 | * linux/arch/unicore32/include/asm/system.h | ||
| 3 | * | ||
| 4 | * Code specific to PKUnity SoC and UniCore ISA | ||
| 5 | * | ||
| 6 | * Copyright (C) 2001-2010 GUAN Xue-tao | ||
| 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 | #ifndef __UNICORE_SYSTEM_H__ | ||
| 13 | #define __UNICORE_SYSTEM_H__ | ||
| 14 | |||
| 15 | #ifdef __KERNEL__ | ||
| 16 | |||
| 17 | /* | ||
| 18 | * CR1 bits (CP#0 CR1) | ||
| 19 | */ | ||
| 20 | #define CR_M (1 << 0) /* MMU enable */ | ||
| 21 | #define CR_A (1 << 1) /* Alignment abort enable */ | ||
| 22 | #define CR_D (1 << 2) /* Dcache enable */ | ||
| 23 | #define CR_I (1 << 3) /* Icache enable */ | ||
| 24 | #define CR_B (1 << 4) /* Dcache write mechanism: write back */ | ||
| 25 | #define CR_T (1 << 5) /* Burst enable */ | ||
| 26 | #define CR_V (1 << 13) /* Vectors relocated to 0xffff0000 */ | ||
| 27 | |||
| 28 | #ifndef __ASSEMBLY__ | ||
| 29 | |||
| 30 | #include <linux/linkage.h> | ||
| 31 | #include <linux/irqflags.h> | ||
| 32 | |||
| 33 | struct thread_info; | ||
| 34 | struct task_struct; | ||
| 35 | |||
| 36 | struct pt_regs; | ||
| 37 | |||
| 38 | void die(const char *msg, struct pt_regs *regs, int err); | ||
| 39 | |||
| 40 | struct siginfo; | ||
| 41 | void uc32_notify_die(const char *str, struct pt_regs *regs, | ||
| 42 | struct siginfo *info, unsigned long err, unsigned long trap); | ||
| 43 | |||
| 44 | void hook_fault_code(int nr, int (*fn)(unsigned long, unsigned int, | ||
| 45 | struct pt_regs *), | ||
| 46 | int sig, int code, const char *name); | ||
| 47 | |||
| 48 | #define xchg(ptr, x) \ | ||
| 49 | ((__typeof__(*(ptr)))__xchg((unsigned long)(x), (ptr), sizeof(*(ptr)))) | ||
| 50 | |||
| 51 | extern asmlinkage void __backtrace(void); | ||
| 52 | extern asmlinkage void c_backtrace(unsigned long fp, int pmode); | ||
| 53 | |||
| 54 | struct mm_struct; | ||
| 55 | extern void show_pte(struct mm_struct *mm, unsigned long addr); | ||
| 56 | extern void __show_regs(struct pt_regs *); | ||
| 57 | |||
| 58 | extern int cpu_architecture(void); | ||
| 59 | extern void cpu_init(void); | ||
| 60 | |||
| 61 | #define vectors_high() (cr_alignment & CR_V) | ||
| 62 | |||
| 63 | #define isb() __asm__ __volatile__ ("" : : : "memory") | ||
| 64 | #define dsb() __asm__ __volatile__ ("" : : : "memory") | ||
| 65 | #define dmb() __asm__ __volatile__ ("" : : : "memory") | ||
| 66 | |||
| 67 | #define mb() barrier() | ||
| 68 | #define rmb() barrier() | ||
| 69 | #define wmb() barrier() | ||
| 70 | #define smp_mb() barrier() | ||
| 71 | #define smp_rmb() barrier() | ||
| 72 | #define smp_wmb() barrier() | ||
| 73 | #define read_barrier_depends() do { } while (0) | ||
| 74 | #define smp_read_barrier_depends() do { } while (0) | ||
| 75 | |||
| 76 | #define set_mb(var, value) do { var = value; smp_mb(); } while (0) | ||
| 77 | #define nop() __asm__ __volatile__("mov\tr0,r0\t@ nop\n\t"); | ||
| 78 | |||
| 79 | extern unsigned long cr_no_alignment; /* defined in entry-unicore.S */ | ||
| 80 | extern unsigned long cr_alignment; /* defined in entry-unicore.S */ | ||
| 81 | |||
| 82 | static inline unsigned int get_cr(void) | ||
| 83 | { | ||
| 84 | unsigned int val; | ||
| 85 | asm("movc %0, p0.c1, #0" : "=r" (val) : : "cc"); | ||
| 86 | return val; | ||
| 87 | } | ||
| 88 | |||
| 89 | static inline void set_cr(unsigned int val) | ||
| 90 | { | ||
| 91 | asm volatile("movc p0.c1, %0, #0 @set CR" | ||
| 92 | : : "r" (val) : "cc"); | ||
| 93 | isb(); | ||
| 94 | } | ||
| 95 | |||
| 96 | extern void adjust_cr(unsigned long mask, unsigned long set); | ||
| 97 | |||
| 98 | /* | ||
| 99 | * switch_to(prev, next) should switch from task `prev' to `next' | ||
| 100 | * `prev' will never be the same as `next'. schedule() itself | ||
| 101 | * contains the memory barrier to tell GCC not to cache `current'. | ||
| 102 | */ | ||
| 103 | extern struct task_struct *__switch_to(struct task_struct *, | ||
| 104 | struct thread_info *, struct thread_info *); | ||
| 105 | extern void panic(const char *fmt, ...); | ||
| 106 | |||
| 107 | #define switch_to(prev, next, last) \ | ||
| 108 | do { \ | ||
| 109 | last = __switch_to(prev, \ | ||
| 110 | task_thread_info(prev), task_thread_info(next)); \ | ||
| 111 | } while (0) | ||
| 112 | |||
| 113 | static inline unsigned long | ||
| 114 | __xchg(unsigned long x, volatile void *ptr, int size) | ||
| 115 | { | ||
| 116 | unsigned long ret; | ||
| 117 | |||
| 118 | switch (size) { | ||
| 119 | case 1: | ||
| 120 | asm volatile("@ __xchg1\n" | ||
| 121 | " swapb %0, %1, [%2]" | ||
| 122 | : "=&r" (ret) | ||
| 123 | : "r" (x), "r" (ptr) | ||
| 124 | : "memory", "cc"); | ||
| 125 | break; | ||
| 126 | case 4: | ||
| 127 | asm volatile("@ __xchg4\n" | ||
| 128 | " swapw %0, %1, [%2]" | ||
| 129 | : "=&r" (ret) | ||
| 130 | : "r" (x), "r" (ptr) | ||
| 131 | : "memory", "cc"); | ||
| 132 | break; | ||
| 133 | default: | ||
| 134 | panic("xchg: bad data size: ptr 0x%p, size %d\n", | ||
| 135 | ptr, size); | ||
| 136 | } | ||
| 137 | |||
| 138 | return ret; | ||
| 139 | } | ||
| 140 | |||
| 141 | #include <asm-generic/cmpxchg-local.h> | ||
| 142 | |||
| 143 | /* | ||
| 144 | * cmpxchg_local and cmpxchg64_local are atomic wrt current CPU. Always make | ||
| 145 | * them available. | ||
| 146 | */ | ||
| 147 | #define cmpxchg_local(ptr, o, n) \ | ||
| 148 | ((__typeof__(*(ptr)))__cmpxchg_local_generic((ptr), \ | ||
| 149 | (unsigned long)(o), (unsigned long)(n), sizeof(*(ptr)))) | ||
| 150 | #define cmpxchg64_local(ptr, o, n) \ | ||
| 151 | __cmpxchg64_local_generic((ptr), (o), (n)) | ||
| 152 | |||
| 153 | #include <asm-generic/cmpxchg.h> | ||
| 154 | |||
| 155 | #endif /* __ASSEMBLY__ */ | ||
| 156 | |||
| 157 | #define arch_align_stack(x) (x) | ||
| 158 | |||
| 159 | #endif /* __KERNEL__ */ | ||
| 160 | |||
| 161 | #endif | ||
diff --git a/arch/unicore32/include/asm/unistd.h b/arch/unicore32/include/asm/unistd.h new file mode 100644 index 00000000000..9b242801996 --- /dev/null +++ b/arch/unicore32/include/asm/unistd.h | |||
| @@ -0,0 +1,18 @@ | |||
| 1 | /* | ||
| 2 | * linux/arch/unicore32/include/asm/unistd.h | ||
| 3 | * | ||
| 4 | * Code specific to PKUnity SoC and UniCore ISA | ||
| 5 | * | ||
| 6 | * Copyright (C) 2001-2010 GUAN Xue-tao | ||
| 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 | #if !defined(__UNICORE_UNISTD_H__) || defined(__SYSCALL) | ||
| 13 | #define __UNICORE_UNISTD_H__ | ||
| 14 | |||
| 15 | /* Use the standard ABI for syscalls. */ | ||
| 16 | #include <asm-generic/unistd.h> | ||
| 17 | |||
| 18 | #endif /* __UNICORE_UNISTD_H__ */ | ||
diff --git a/arch/unicore32/kernel/init_task.c b/arch/unicore32/kernel/init_task.c new file mode 100644 index 00000000000..a35a1e50e4f --- /dev/null +++ b/arch/unicore32/kernel/init_task.c | |||
| @@ -0,0 +1,44 @@ | |||
| 1 | /* | ||
| 2 | * linux/arch/unicore32/kernel/init_task.c | ||
| 3 | * | ||
| 4 | * Code specific to PKUnity SoC and UniCore ISA | ||
| 5 | * | ||
| 6 | * Copyright (C) 2001-2010 GUAN Xue-tao | ||
| 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 | #include <linux/mm.h> | ||
| 13 | #include <linux/module.h> | ||
| 14 | #include <linux/fs.h> | ||
| 15 | #include <linux/sched.h> | ||
| 16 | #include <linux/init.h> | ||
| 17 | #include <linux/init_task.h> | ||
| 18 | #include <linux/mqueue.h> | ||
| 19 | #include <linux/uaccess.h> | ||
| 20 | |||
| 21 | #include <asm/pgtable.h> | ||
| 22 | |||
| 23 | static struct signal_struct init_signals = INIT_SIGNALS(init_signals); | ||
| 24 | static struct sighand_struct init_sighand = INIT_SIGHAND(init_sighand); | ||
| 25 | /* | ||
| 26 | * Initial thread structure. | ||
| 27 | * | ||
| 28 | * We need to make sure that this is 8192-byte aligned due to the | ||
| 29 | * way process stacks are handled. This is done by making sure | ||
| 30 | * the linker maps this in the .text segment right after head.S, | ||
| 31 | * and making head.S ensure the proper alignment. | ||
| 32 | * | ||
| 33 | * The things we do for performance.. | ||
| 34 | */ | ||
| 35 | union thread_union init_thread_union __init_task_data = { | ||
| 36 | INIT_THREAD_INFO(init_task) }; | ||
| 37 | |||
| 38 | /* | ||
| 39 | * Initial task structure. | ||
| 40 | * | ||
| 41 | * All other task structs will be allocated on slabs in fork.c | ||
| 42 | */ | ||
| 43 | struct task_struct init_task = INIT_TASK(init_task); | ||
| 44 | EXPORT_SYMBOL(init_task); | ||
diff --git a/arch/unicore32/kernel/pwm.c b/arch/unicore32/kernel/pwm.c new file mode 100644 index 00000000000..4615d51e3ba --- /dev/null +++ b/arch/unicore32/kernel/pwm.c | |||
| @@ -0,0 +1,263 @@ | |||
| 1 | /* | ||
| 2 | * linux/arch/unicore32/kernel/pwm.c | ||
| 3 | * | ||
| 4 | * Code specific to PKUnity SoC and UniCore ISA | ||
| 5 | * | ||
| 6 | * Maintained by GUAN Xue-tao <gxt@mprc.pku.edu.cn> | ||
| 7 | * Copyright (C) 2001-2010 Guan Xuetao | ||
| 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/module.h> | ||
| 15 | #include <linux/kernel.h> | ||
| 16 | #include <linux/platform_device.h> | ||
| 17 | #include <linux/slab.h> | ||
| 18 | #include <linux/err.h> | ||
| 19 | #include <linux/clk.h> | ||
| 20 | #include <linux/io.h> | ||
| 21 | #include <linux/pwm.h> | ||
| 22 | |||
| 23 | #include <asm/div64.h> | ||
| 24 | #include <mach/hardware.h> | ||
| 25 | |||
| 26 | struct pwm_device { | ||
| 27 | struct list_head node; | ||
| 28 | struct platform_device *pdev; | ||
| 29 | |||
| 30 | const char *label; | ||
| 31 | struct clk *clk; | ||
| 32 | int clk_enabled; | ||
| 33 | |||
| 34 | unsigned int use_count; | ||
| 35 | unsigned int pwm_id; | ||
| 36 | }; | ||
| 37 | |||
| 38 | /* | ||
| 39 | * period_ns = 10^9 * (PRESCALE + 1) * (PV + 1) / PWM_CLK_RATE | ||
| 40 | * duty_ns = 10^9 * (PRESCALE + 1) * DC / PWM_CLK_RATE | ||
| 41 | */ | ||
| 42 | int pwm_config(struct pwm_device *pwm, int duty_ns, int period_ns) | ||
| 43 | { | ||
| 44 | unsigned long long c; | ||
| 45 | unsigned long period_cycles, prescale, pv, dc; | ||
| 46 | |||
| 47 | if (pwm == NULL || period_ns == 0 || duty_ns > period_ns) | ||
| 48 | return -EINVAL; | ||
| 49 | |||
| 50 | c = clk_get_rate(pwm->clk); | ||
| 51 | c = c * period_ns; | ||
| 52 | do_div(c, 1000000000); | ||
| 53 | period_cycles = c; | ||
| 54 | |||
| 55 | if (period_cycles < 1) | ||
| 56 | period_cycles = 1; | ||
| 57 | prescale = (period_cycles - 1) / 1024; | ||
| 58 | pv = period_cycles / (prescale + 1) - 1; | ||
| 59 | |||
| 60 | if (prescale > 63) | ||
| 61 | return -EINVAL; | ||
| 62 | |||
| 63 | if (duty_ns == period_ns) | ||
| 64 | dc = OST_PWMDCCR_FDCYCLE; | ||
| 65 | else | ||
| 66 | dc = (pv + 1) * duty_ns / period_ns; | ||
| 67 | |||
| 68 | /* NOTE: the clock to PWM has to be enabled first | ||
| 69 | * before writing to the registers | ||
| 70 | */ | ||
| 71 | clk_enable(pwm->clk); | ||
| 72 | OST_PWMPWCR = prescale; | ||
| 73 | OST_PWMDCCR = pv - dc; | ||
| 74 | OST_PWMPCR = pv; | ||
| 75 | clk_disable(pwm->clk); | ||
| 76 | |||
| 77 | return 0; | ||
| 78 | } | ||
| 79 | EXPORT_SYMBOL(pwm_config); | ||
| 80 | |||
| 81 | int pwm_enable(struct pwm_device *pwm) | ||
| 82 | { | ||
| 83 | int rc = 0; | ||
| 84 | |||
| 85 | if (!pwm->clk_enabled) { | ||
| 86 | rc = clk_enable(pwm->clk); | ||
| 87 | if (!rc) | ||
| 88 | pwm->clk_enabled = 1; | ||
| 89 | } | ||
| 90 | return rc; | ||
| 91 | } | ||
| 92 | EXPORT_SYMBOL(pwm_enable); | ||
| 93 | |||
| 94 | void pwm_disable(struct pwm_device *pwm) | ||
| 95 | { | ||
| 96 | if (pwm->clk_enabled) { | ||
| 97 | clk_disable(pwm->clk); | ||
| 98 | pwm->clk_enabled = 0; | ||
| 99 | } | ||
| 100 | } | ||
| 101 | EXPORT_SYMBOL(pwm_disable); | ||
| 102 | |||
| 103 | static DEFINE_MUTEX(pwm_lock); | ||
| 104 | static LIST_HEAD(pwm_list); | ||
| 105 | |||
| 106 | struct pwm_device *pwm_request(int pwm_id, const char *label) | ||
| 107 | { | ||
| 108 | struct pwm_device *pwm; | ||
| 109 | int found = 0; | ||
| 110 | |||
| 111 | mutex_lock(&pwm_lock); | ||
| 112 | |||
| 113 | list_for_each_entry(pwm, &pwm_list, node) { | ||
| 114 | if (pwm->pwm_id == pwm_id) { | ||
| 115 | found = 1; | ||
| 116 | break; | ||
| 117 | } | ||
| 118 | } | ||
| 119 | |||
| 120 | if (found) { | ||
| 121 | if (pwm->use_count == 0) { | ||
| 122 | pwm->use_count++; | ||
| 123 | pwm->label = label; | ||
| 124 | } else | ||
| 125 | pwm = ERR_PTR(-EBUSY); | ||
| 126 | } else | ||
| 127 | pwm = ERR_PTR(-ENOENT); | ||
| 128 | |||
| 129 | mutex_unlock(&pwm_lock); | ||
| 130 | return pwm; | ||
| 131 | } | ||
| 132 | EXPORT_SYMBOL(pwm_request); | ||
| 133 | |||
| 134 | void pwm_free(struct pwm_device *pwm) | ||
| 135 | { | ||
| 136 | mutex_lock(&pwm_lock); | ||
| 137 | |||
| 138 | if (pwm->use_count) { | ||
| 139 | pwm->use_count--; | ||
| 140 | pwm->label = NULL; | ||
| 141 | } else | ||
| 142 | pr_warning("PWM device already freed\n"); | ||
| 143 | |||
| 144 | mutex_unlock(&pwm_lock); | ||
| 145 | } | ||
| 146 | EXPORT_SYMBOL(pwm_free); | ||
| 147 | |||
| 148 | static inline void __add_pwm(struct pwm_device *pwm) | ||
| 149 | { | ||
| 150 | mutex_lock(&pwm_lock); | ||
| 151 | list_add_tail(&pwm->node, &pwm_list); | ||
| 152 | mutex_unlock(&pwm_lock); | ||
| 153 | } | ||
| 154 | |||
| 155 | static struct pwm_device *pwm_probe(struct platform_device *pdev, | ||
| 156 | unsigned int pwm_id, struct pwm_device *parent_pwm) | ||
| 157 | { | ||
| 158 | struct pwm_device *pwm; | ||
| 159 | struct resource *r; | ||
| 160 | int ret = 0; | ||
| 161 | |||
| 162 | pwm = kzalloc(sizeof(struct pwm_device), GFP_KERNEL); | ||
| 163 | if (pwm == NULL) { | ||
| 164 | dev_err(&pdev->dev, "failed to allocate memory\n"); | ||
| 165 | return ERR_PTR(-ENOMEM); | ||
| 166 | } | ||
| 167 | |||
| 168 | pwm->clk = clk_get(NULL, "OST_CLK"); | ||
| 169 | if (IS_ERR(pwm->clk)) { | ||
| 170 | ret = PTR_ERR(pwm->clk); | ||
| 171 | goto err_free; | ||
| 172 | } | ||
| 173 | pwm->clk_enabled = 0; | ||
| 174 | |||
| 175 | pwm->use_count = 0; | ||
| 176 | pwm->pwm_id = pwm_id; | ||
| 177 | pwm->pdev = pdev; | ||
| 178 | |||
| 179 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
| 180 | if (r == NULL) { | ||
| 181 | dev_err(&pdev->dev, "no memory resource defined\n"); | ||
| 182 | ret = -ENODEV; | ||
| 183 | goto err_free_clk; | ||
| 184 | } | ||
| 185 | |||
| 186 | r = request_mem_region(r->start, resource_size(r), pdev->name); | ||
| 187 | if (r == NULL) { | ||
| 188 | dev_err(&pdev->dev, "failed to request memory resource\n"); | ||
| 189 | ret = -EBUSY; | ||
| 190 | goto err_free_clk; | ||
| 191 | } | ||
| 192 | |||
| 193 | __add_pwm(pwm); | ||
| 194 | platform_set_drvdata(pdev, pwm); | ||
| 195 | return pwm; | ||
| 196 | |||
| 197 | err_free_clk: | ||
| 198 | clk_put(pwm->clk); | ||
| 199 | err_free: | ||
| 200 | kfree(pwm); | ||
| 201 | return ERR_PTR(ret); | ||
| 202 | } | ||
| 203 | |||
| 204 | static int __devinit puv3_pwm_probe(struct platform_device *pdev) | ||
| 205 | { | ||
| 206 | struct pwm_device *pwm = pwm_probe(pdev, pdev->id, NULL); | ||
| 207 | |||
| 208 | if (IS_ERR(pwm)) | ||
| 209 | return PTR_ERR(pwm); | ||
| 210 | |||
| 211 | return 0; | ||
| 212 | } | ||
| 213 | |||
| 214 | static int __devexit pwm_remove(struct platform_device *pdev) | ||
| 215 | { | ||
| 216 | struct pwm_device *pwm; | ||
| 217 | struct resource *r; | ||
| 218 | |||
| 219 | pwm = platform_get_drvdata(pdev); | ||
| 220 | if (pwm == NULL) | ||
| 221 | return -ENODEV; | ||
| 222 | |||
| 223 | mutex_lock(&pwm_lock); | ||
| 224 | list_del(&pwm->node); | ||
| 225 | mutex_unlock(&pwm_lock); | ||
| 226 | |||
| 227 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
| 228 | release_mem_region(r->start, resource_size(r)); | ||
| 229 | |||
| 230 | clk_put(pwm->clk); | ||
| 231 | kfree(pwm); | ||
| 232 | return 0; | ||
| 233 | } | ||
| 234 | |||
| 235 | static struct platform_driver puv3_pwm_driver = { | ||
| 236 | .driver = { | ||
| 237 | .name = "PKUnity-v3-PWM", | ||
| 238 | }, | ||
| 239 | .probe = puv3_pwm_probe, | ||
| 240 | .remove = __devexit_p(pwm_remove), | ||
| 241 | }; | ||
| 242 | |||
| 243 | static int __init pwm_init(void) | ||
| 244 | { | ||
| 245 | int ret = 0; | ||
| 246 | |||
| 247 | ret = platform_driver_register(&puv3_pwm_driver); | ||
| 248 | if (ret) { | ||
| 249 | printk(KERN_ERR "failed to register puv3_pwm_driver\n"); | ||
| 250 | return ret; | ||
| 251 | } | ||
| 252 | |||
| 253 | return ret; | ||
| 254 | } | ||
| 255 | arch_initcall(pwm_init); | ||
| 256 | |||
| 257 | static void __exit pwm_exit(void) | ||
| 258 | { | ||
| 259 | platform_driver_unregister(&puv3_pwm_driver); | ||
| 260 | } | ||
| 261 | module_exit(pwm_exit); | ||
| 262 | |||
| 263 | MODULE_LICENSE("GPL v2"); | ||
