Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 LT |
2 | * Precise Delay Loops for S390 |
3 | * | |
a53c8fab | 4 | * Copyright IBM Corp. 1999, 2008 |
d3d238c7 HC |
5 | * Author(s): Martin Schwidefsky <schwidefsky@de.ibm.com>, |
6 | * Heiko Carstens <heiko.carstens@de.ibm.com>, | |
1da177e4 LT |
7 | */ |
8 | ||
1da177e4 LT |
9 | #include <linux/sched.h> |
10 | #include <linux/delay.h> | |
d54853ef | 11 | #include <linux/timex.h> |
1485c5c8 | 12 | #include <linux/module.h> |
d54853ef | 13 | #include <linux/irqflags.h> |
bf6f6aa4 | 14 | #include <linux/interrupt.h> |
db7e007f | 15 | #include <linux/irq.h> |
27f6b416 | 16 | #include <asm/vtimer.h> |
b3966378 | 17 | #include <asm/div64.h> |
db7e007f | 18 | #include <asm/idle.h> |
1da177e4 LT |
19 | |
20 | void __delay(unsigned long loops) | |
21 | { | |
22 | /* | |
23 | * To end the bloody studid and useless discussion about the | |
24 | * BogoMips number I took the liberty to define the __delay | |
25 | * function in a way that that resulting BogoMips number will | |
26 | * yield the megahertz number of the cpu. The important function | |
27 | * is udelay and that is done using the tod clock. -- martin. | |
28 | */ | |
94c12cc7 | 29 | asm volatile("0: brct %0,0b" : : "d" ((loops/2) + 1)); |
1da177e4 | 30 | } |
854508c0 | 31 | EXPORT_SYMBOL(__delay); |
1da177e4 | 32 | |
0cd6a403 | 33 | static void __udelay_disabled(unsigned long long usecs) |
1da177e4 | 34 | { |
db7e007f HC |
35 | unsigned long cr0, cr0_new, psw_mask; |
36 | struct s390_idle_data idle; | |
37 | u64 end; | |
d54853ef | 38 | |
1aae0560 | 39 | end = get_tod_clock() + (usecs << 12); |
4c1051e3 | 40 | __ctl_store(cr0, 0, 0); |
db7e007f HC |
41 | cr0_new = cr0 & ~CR0_IRQ_SUBCLASS_MASK; |
42 | cr0_new |= (1UL << (63 - 52)); /* enable clock comparator irq */ | |
43 | __ctl_load(cr0_new, 0, 0); | |
44 | psw_mask = __extract_psw() | PSW_MASK_EXT | PSW_MASK_WAIT; | |
45 | set_clock_comparator(end); | |
46 | set_cpu_flag(CIF_IGNORE_IRQ); | |
47 | psw_idle(&idle, psw_mask); | |
48 | clear_cpu_flag(CIF_IGNORE_IRQ); | |
49 | set_clock_comparator(S390_lowcore.clock_comparator); | |
4c1051e3 | 50 | __ctl_load(cr0, 0, 0); |
d3d238c7 | 51 | } |
d54853ef | 52 | |
0cd6a403 | 53 | static void __udelay_enabled(unsigned long long usecs) |
d3d238c7 | 54 | { |
4c1051e3 | 55 | u64 clock_saved, end; |
d3d238c7 | 56 | |
8c071b0f | 57 | end = get_tod_clock_fast() + (usecs << 12); |
d54853ef | 58 | do { |
78d81f2f CB |
59 | clock_saved = 0; |
60 | if (end < S390_lowcore.clock_comparator) { | |
61 | clock_saved = local_tick_disable(); | |
62 | set_clock_comparator(end); | |
63 | } | |
b5f87f15 | 64 | enabled_wait(); |
78d81f2f CB |
65 | if (clock_saved) |
66 | local_tick_enable(clock_saved); | |
8c071b0f | 67 | } while (get_tod_clock_fast() < end); |
d3d238c7 | 68 | } |
1da177e4 | 69 | |
d3d238c7 HC |
70 | /* |
71 | * Waits for 'usecs' microseconds using the TOD clock comparator. | |
72 | */ | |
0cd6a403 | 73 | void __udelay(unsigned long long usecs) |
d3d238c7 HC |
74 | { |
75 | unsigned long flags; | |
76 | ||
77 | preempt_disable(); | |
78 | local_irq_save(flags); | |
79 | if (in_irq()) { | |
80 | __udelay_disabled(usecs); | |
81 | goto out; | |
82 | } | |
83 | if (in_softirq()) { | |
84 | if (raw_irqs_disabled_flags(flags)) | |
85 | __udelay_disabled(usecs); | |
86 | else | |
87 | __udelay_enabled(usecs); | |
88 | goto out; | |
d54853ef | 89 | } |
d3d238c7 HC |
90 | if (raw_irqs_disabled_flags(flags)) { |
91 | local_bh_disable(); | |
92 | __udelay_disabled(usecs); | |
bf6f6aa4 | 93 | _local_bh_enable(); |
d3d238c7 HC |
94 | goto out; |
95 | } | |
96 | __udelay_enabled(usecs); | |
97 | out: | |
d54853ef | 98 | local_irq_restore(flags); |
d3d238c7 | 99 | preempt_enable(); |
1da177e4 | 100 | } |
1485c5c8 | 101 | EXPORT_SYMBOL(__udelay); |
5a0d0e65 HC |
102 | |
103 | /* | |
104 | * Simple udelay variant. To be used on startup and reboot | |
105 | * when the interrupt handler isn't working. | |
106 | */ | |
0cd6a403 | 107 | void udelay_simple(unsigned long long usecs) |
5a0d0e65 HC |
108 | { |
109 | u64 end; | |
110 | ||
8c071b0f MS |
111 | end = get_tod_clock_fast() + (usecs << 12); |
112 | while (get_tod_clock_fast() < end) | |
5a0d0e65 HC |
113 | cpu_relax(); |
114 | } | |
b3966378 HC |
115 | |
116 | void __ndelay(unsigned long long nsecs) | |
117 | { | |
118 | u64 end; | |
119 | ||
120 | nsecs <<= 9; | |
121 | do_div(nsecs, 125); | |
8c071b0f | 122 | end = get_tod_clock_fast() + nsecs; |
b3966378 HC |
123 | if (nsecs & ~0xfffUL) |
124 | __udelay(nsecs >> 12); | |
8c071b0f | 125 | while (get_tod_clock_fast() < end) |
b3966378 HC |
126 | barrier(); |
127 | } | |
128 | EXPORT_SYMBOL(__ndelay); |