| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 1 | /* | 
|  | 2 | * Telecom Clock driver for Intel NetStructure(tm) MPCBL0010 | 
|  | 3 | * | 
|  | 4 | * Copyright (C) 2005 Kontron Canada | 
|  | 5 | * | 
|  | 6 | * All rights reserved. | 
|  | 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 as published by | 
|  | 10 | * the Free Software Foundation; either version 2 of the License, or (at | 
|  | 11 | * your option) any later version. | 
|  | 12 | * | 
|  | 13 | * This program is distributed in the hope that it will be useful, but | 
|  | 14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 15 | * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or | 
|  | 16 | * NON INFRINGEMENT.  See the GNU General Public License for more | 
|  | 17 | * details. | 
|  | 18 | * | 
|  | 19 | * You should have received a copy of the GNU General Public License | 
|  | 20 | * along with this program; if not, write to the Free Software | 
|  | 21 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
|  | 22 | * | 
|  | 23 | * Send feedback to <sebastien.bouchard@ca.kontron.com> and the current | 
|  | 24 | * Maintainer  <mark.gross@intel.com> | 
|  | 25 | * | 
|  | 26 | * Description : This is the TELECOM CLOCK module driver for the ATCA | 
|  | 27 | * MPCBL0010 ATCA computer. | 
|  | 28 | */ | 
|  | 29 |  | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 30 | #include <linux/module.h> | 
|  | 31 | #include <linux/init.h> | 
|  | 32 | #include <linux/sched.h> | 
|  | 33 | #include <linux/kernel.h>	/* printk() */ | 
|  | 34 | #include <linux/fs.h>		/* everything... */ | 
|  | 35 | #include <linux/errno.h>	/* error codes */ | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 36 | #include <linux/slab.h> | 
|  | 37 | #include <linux/ioport.h> | 
|  | 38 | #include <linux/interrupt.h> | 
|  | 39 | #include <linux/spinlock.h> | 
|  | 40 | #include <linux/timer.h> | 
|  | 41 | #include <linux/sysfs.h> | 
|  | 42 | #include <linux/device.h> | 
|  | 43 | #include <linux/miscdevice.h> | 
| Andrew Morton | ce46337 | 2005-10-31 23:44:30 -0800 | [diff] [blame] | 44 | #include <linux/platform_device.h> | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 45 | #include <asm/io.h>		/* inb/outb */ | 
|  | 46 | #include <asm/uaccess.h> | 
|  | 47 |  | 
|  | 48 | MODULE_AUTHOR("Sebastien Bouchard <sebastien.bouchard@ca.kontron.com>"); | 
|  | 49 | MODULE_LICENSE("GPL"); | 
|  | 50 |  | 
|  | 51 | /*Hardware Reset of the PLL */ | 
|  | 52 | #define RESET_ON	0x00 | 
|  | 53 | #define RESET_OFF	0x01 | 
|  | 54 |  | 
|  | 55 | /* MODE SELECT */ | 
|  | 56 | #define NORMAL_MODE 	0x00 | 
|  | 57 | #define HOLDOVER_MODE	0x10 | 
|  | 58 | #define FREERUN_MODE	0x20 | 
|  | 59 |  | 
|  | 60 | /* FILTER SELECT */ | 
|  | 61 | #define FILTER_6HZ	0x04 | 
|  | 62 | #define FILTER_12HZ	0x00 | 
|  | 63 |  | 
|  | 64 | /* SELECT REFERENCE FREQUENCY */ | 
|  | 65 | #define REF_CLK1_8kHz		0x00 | 
|  | 66 | #define REF_CLK2_19_44MHz	0x02 | 
|  | 67 |  | 
|  | 68 | /* Select primary or secondary redundant clock */ | 
|  | 69 | #define PRIMARY_CLOCK	0x00 | 
|  | 70 | #define SECONDARY_CLOCK	0x01 | 
|  | 71 |  | 
|  | 72 | /* CLOCK TRANSMISSION DEFINE */ | 
|  | 73 | #define CLK_8kHz	0xff | 
|  | 74 | #define CLK_16_384MHz	0xfb | 
|  | 75 |  | 
|  | 76 | #define CLK_1_544MHz	0x00 | 
|  | 77 | #define CLK_2_048MHz	0x01 | 
|  | 78 | #define CLK_4_096MHz	0x02 | 
|  | 79 | #define CLK_6_312MHz	0x03 | 
|  | 80 | #define CLK_8_192MHz	0x04 | 
|  | 81 | #define CLK_19_440MHz	0x06 | 
|  | 82 |  | 
|  | 83 | #define CLK_8_592MHz	0x08 | 
|  | 84 | #define CLK_11_184MHz	0x09 | 
|  | 85 | #define CLK_34_368MHz	0x0b | 
|  | 86 | #define CLK_44_736MHz	0x0a | 
|  | 87 |  | 
|  | 88 | /* RECEIVED REFERENCE */ | 
|  | 89 | #define AMC_B1 0 | 
|  | 90 | #define AMC_B2 1 | 
|  | 91 |  | 
|  | 92 | /* HARDWARE SWITCHING DEFINE */ | 
|  | 93 | #define HW_ENABLE	0x80 | 
|  | 94 | #define HW_DISABLE	0x00 | 
|  | 95 |  | 
|  | 96 | /* HARDWARE SWITCHING MODE DEFINE */ | 
|  | 97 | #define PLL_HOLDOVER	0x40 | 
|  | 98 | #define LOST_CLOCK	0x00 | 
|  | 99 |  | 
|  | 100 | /* ALARMS DEFINE */ | 
|  | 101 | #define UNLOCK_MASK	0x10 | 
|  | 102 | #define HOLDOVER_MASK	0x20 | 
|  | 103 | #define SEC_LOST_MASK	0x40 | 
|  | 104 | #define PRI_LOST_MASK	0x80 | 
|  | 105 |  | 
|  | 106 | /* INTERRUPT CAUSE DEFINE */ | 
|  | 107 |  | 
|  | 108 | #define PRI_LOS_01_MASK		0x01 | 
|  | 109 | #define PRI_LOS_10_MASK		0x02 | 
|  | 110 |  | 
|  | 111 | #define SEC_LOS_01_MASK		0x04 | 
|  | 112 | #define SEC_LOS_10_MASK		0x08 | 
|  | 113 |  | 
|  | 114 | #define HOLDOVER_01_MASK	0x10 | 
|  | 115 | #define HOLDOVER_10_MASK	0x20 | 
|  | 116 |  | 
|  | 117 | #define UNLOCK_01_MASK		0x40 | 
|  | 118 | #define UNLOCK_10_MASK		0x80 | 
|  | 119 |  | 
|  | 120 | struct tlclk_alarms { | 
|  | 121 | __u32 lost_clocks; | 
|  | 122 | __u32 lost_primary_clock; | 
|  | 123 | __u32 lost_secondary_clock; | 
|  | 124 | __u32 primary_clock_back; | 
|  | 125 | __u32 secondary_clock_back; | 
|  | 126 | __u32 switchover_primary; | 
|  | 127 | __u32 switchover_secondary; | 
|  | 128 | __u32 pll_holdover; | 
|  | 129 | __u32 pll_end_holdover; | 
|  | 130 | __u32 pll_lost_sync; | 
|  | 131 | __u32 pll_sync; | 
|  | 132 | }; | 
|  | 133 | /* Telecom clock I/O register definition */ | 
|  | 134 | #define TLCLK_BASE 0xa08 | 
|  | 135 | #define TLCLK_REG0 TLCLK_BASE | 
|  | 136 | #define TLCLK_REG1 (TLCLK_BASE+1) | 
|  | 137 | #define TLCLK_REG2 (TLCLK_BASE+2) | 
|  | 138 | #define TLCLK_REG3 (TLCLK_BASE+3) | 
|  | 139 | #define TLCLK_REG4 (TLCLK_BASE+4) | 
|  | 140 | #define TLCLK_REG5 (TLCLK_BASE+5) | 
|  | 141 | #define TLCLK_REG6 (TLCLK_BASE+6) | 
|  | 142 | #define TLCLK_REG7 (TLCLK_BASE+7) | 
|  | 143 |  | 
|  | 144 | #define SET_PORT_BITS(port, mask, val) outb(((inb(port) & mask) | val), port) | 
|  | 145 |  | 
|  | 146 | /* 0 = Dynamic allocation of the major device number */ | 
|  | 147 | #define TLCLK_MAJOR 0 | 
|  | 148 |  | 
|  | 149 | /* sysfs interface definition: | 
|  | 150 | Upon loading the driver will create a sysfs directory under | 
|  | 151 | /sys/devices/platform/telco_clock. | 
|  | 152 |  | 
|  | 153 | This directory exports the following interfaces.  There operation is | 
|  | 154 | documented in the MCPBL0010 TPS under the Telecom Clock API section, 11.4. | 
|  | 155 | alarms				: | 
|  | 156 | current_ref			: | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 157 | received_ref_clk3a		: | 
|  | 158 | received_ref_clk3b		: | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 159 | enable_clk3a_output		: | 
|  | 160 | enable_clk3b_output		: | 
|  | 161 | enable_clka0_output		: | 
|  | 162 | enable_clka1_output		: | 
|  | 163 | enable_clkb0_output		: | 
|  | 164 | enable_clkb1_output		: | 
|  | 165 | filter_select			: | 
|  | 166 | hardware_switching		: | 
|  | 167 | hardware_switching_mode		: | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 168 | telclock_version		: | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 169 | mode_select			: | 
|  | 170 | refalign			: | 
|  | 171 | reset				: | 
|  | 172 | select_amcb1_transmit_clock	: | 
|  | 173 | select_amcb2_transmit_clock	: | 
|  | 174 | select_redundant_clock		: | 
|  | 175 | select_ref_frequency		: | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 176 |  | 
|  | 177 | All sysfs interfaces are integers in hex format, i.e echo 99 > refalign | 
|  | 178 | has the same effect as echo 0x99 > refalign. | 
|  | 179 | */ | 
|  | 180 |  | 
|  | 181 | static unsigned int telclk_interrupt; | 
|  | 182 |  | 
|  | 183 | static int int_events;		/* Event that generate a interrupt */ | 
|  | 184 | static int got_event;		/* if events processing have been done */ | 
|  | 185 |  | 
|  | 186 | static void switchover_timeout(unsigned long data); | 
|  | 187 | static struct timer_list switchover_timer = | 
|  | 188 | TIMER_INITIALIZER(switchover_timeout , 0, 0); | 
|  | 189 |  | 
|  | 190 | static struct tlclk_alarms *alarm_events; | 
|  | 191 |  | 
|  | 192 | static DEFINE_SPINLOCK(event_lock); | 
|  | 193 |  | 
|  | 194 | static int tlclk_major = TLCLK_MAJOR; | 
|  | 195 |  | 
|  | 196 | static irqreturn_t tlclk_interrupt(int irq, void *dev_id, struct pt_regs *regs); | 
|  | 197 |  | 
|  | 198 | static DECLARE_WAIT_QUEUE_HEAD(wq); | 
|  | 199 |  | 
|  | 200 | static int tlclk_open(struct inode *inode, struct file *filp) | 
|  | 201 | { | 
|  | 202 | int result; | 
|  | 203 |  | 
|  | 204 | /* Make sure there is no interrupt pending while | 
|  | 205 | * initialising interrupt handler */ | 
|  | 206 | inb(TLCLK_REG6); | 
|  | 207 |  | 
|  | 208 | /* This device is wired through the FPGA IO space of the ATCA blade | 
|  | 209 | * we can't share this IRQ */ | 
|  | 210 | result = request_irq(telclk_interrupt, &tlclk_interrupt, | 
| Thomas Gleixner | 0f2ed4c | 2006-07-01 19:29:33 -0700 | [diff] [blame] | 211 | IRQF_DISABLED, "telco_clock", tlclk_interrupt); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 212 | if (result == -EBUSY) { | 
| Alan Cox | 4ab2495 | 2006-01-11 12:17:33 -0800 | [diff] [blame] | 213 | printk(KERN_ERR "tlclk: Interrupt can't be reserved.\n"); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 214 | return -EBUSY; | 
|  | 215 | } | 
|  | 216 | inb(TLCLK_REG6);	/* Clear interrupt events */ | 
|  | 217 |  | 
|  | 218 | return 0; | 
|  | 219 | } | 
|  | 220 |  | 
|  | 221 | static int tlclk_release(struct inode *inode, struct file *filp) | 
|  | 222 | { | 
|  | 223 | free_irq(telclk_interrupt, tlclk_interrupt); | 
|  | 224 |  | 
|  | 225 | return 0; | 
|  | 226 | } | 
|  | 227 |  | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 228 | static ssize_t tlclk_read(struct file *filp, char __user *buf, size_t count, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 229 | loff_t *f_pos) | 
|  | 230 | { | 
|  | 231 | if (count < sizeof(struct tlclk_alarms)) | 
|  | 232 | return -EIO; | 
|  | 233 |  | 
|  | 234 | wait_event_interruptible(wq, got_event); | 
|  | 235 | if (copy_to_user(buf, alarm_events, sizeof(struct tlclk_alarms))) | 
|  | 236 | return -EFAULT; | 
|  | 237 |  | 
|  | 238 | memset(alarm_events, 0, sizeof(struct tlclk_alarms)); | 
|  | 239 | got_event = 0; | 
|  | 240 |  | 
|  | 241 | return  sizeof(struct tlclk_alarms); | 
|  | 242 | } | 
|  | 243 |  | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 244 | static ssize_t tlclk_write(struct file *filp, const char __user *buf, size_t count, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 245 | loff_t *f_pos) | 
|  | 246 | { | 
|  | 247 | return 0; | 
|  | 248 | } | 
|  | 249 |  | 
| Arjan van de Ven | 62322d2 | 2006-07-03 00:24:21 -0700 | [diff] [blame] | 250 | static const struct file_operations tlclk_fops = { | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 251 | .read = tlclk_read, | 
|  | 252 | .write = tlclk_write, | 
|  | 253 | .open = tlclk_open, | 
|  | 254 | .release = tlclk_release, | 
|  | 255 |  | 
|  | 256 | }; | 
|  | 257 |  | 
|  | 258 | static struct miscdevice tlclk_miscdev = { | 
|  | 259 | .minor = MISC_DYNAMIC_MINOR, | 
|  | 260 | .name = "telco_clock", | 
|  | 261 | .fops = &tlclk_fops, | 
|  | 262 | }; | 
|  | 263 |  | 
|  | 264 | static ssize_t show_current_ref(struct device *d, | 
|  | 265 | struct device_attribute *attr, char *buf) | 
|  | 266 | { | 
|  | 267 | unsigned long ret_val; | 
|  | 268 | unsigned long flags; | 
|  | 269 |  | 
|  | 270 | spin_lock_irqsave(&event_lock, flags); | 
|  | 271 | ret_val = ((inb(TLCLK_REG1) & 0x08) >> 3); | 
|  | 272 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 273 |  | 
|  | 274 | return sprintf(buf, "0x%lX\n", ret_val); | 
|  | 275 | } | 
|  | 276 |  | 
|  | 277 | static DEVICE_ATTR(current_ref, S_IRUGO, show_current_ref, NULL); | 
|  | 278 |  | 
|  | 279 |  | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 280 | static ssize_t show_telclock_version(struct device *d, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 281 | struct device_attribute *attr, char *buf) | 
|  | 282 | { | 
|  | 283 | unsigned long ret_val; | 
|  | 284 | unsigned long flags; | 
|  | 285 |  | 
|  | 286 | spin_lock_irqsave(&event_lock, flags); | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 287 | ret_val = inb(TLCLK_REG5); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 288 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 289 |  | 
|  | 290 | return sprintf(buf, "0x%lX\n", ret_val); | 
|  | 291 | } | 
|  | 292 |  | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 293 | static DEVICE_ATTR(telclock_version, S_IRUGO, | 
|  | 294 | show_telclock_version, NULL); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 295 |  | 
|  | 296 | static ssize_t show_alarms(struct device *d, | 
|  | 297 | struct device_attribute *attr,  char *buf) | 
|  | 298 | { | 
|  | 299 | unsigned long ret_val; | 
|  | 300 | unsigned long flags; | 
|  | 301 |  | 
|  | 302 | spin_lock_irqsave(&event_lock, flags); | 
|  | 303 | ret_val = (inb(TLCLK_REG2) & 0xf0); | 
|  | 304 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 305 |  | 
|  | 306 | return sprintf(buf, "0x%lX\n", ret_val); | 
|  | 307 | } | 
|  | 308 |  | 
|  | 309 | static DEVICE_ATTR(alarms, S_IRUGO, show_alarms, NULL); | 
|  | 310 |  | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 311 | static ssize_t store_received_ref_clk3a(struct device *d, | 
|  | 312 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 313 | { | 
|  | 314 | unsigned long tmp; | 
|  | 315 | unsigned char val; | 
|  | 316 | unsigned long flags; | 
|  | 317 |  | 
|  | 318 | sscanf(buf, "%lX", &tmp); | 
|  | 319 | dev_dbg(d, ": tmp = 0x%lX\n", tmp); | 
|  | 320 |  | 
|  | 321 | val = (unsigned char)tmp; | 
|  | 322 | spin_lock_irqsave(&event_lock, flags); | 
|  | 323 | SET_PORT_BITS(TLCLK_REG1, 0xef, val); | 
|  | 324 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 325 |  | 
|  | 326 | return strnlen(buf, count); | 
|  | 327 | } | 
|  | 328 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 329 | static DEVICE_ATTR(received_ref_clk3a, (S_IWUSR|S_IWGRP), NULL, | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 330 | store_received_ref_clk3a); | 
|  | 331 |  | 
|  | 332 |  | 
|  | 333 | static ssize_t store_received_ref_clk3b(struct device *d, | 
|  | 334 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 335 | { | 
|  | 336 | unsigned long tmp; | 
|  | 337 | unsigned char val; | 
|  | 338 | unsigned long flags; | 
|  | 339 |  | 
|  | 340 | sscanf(buf, "%lX", &tmp); | 
|  | 341 | dev_dbg(d, ": tmp = 0x%lX\n", tmp); | 
|  | 342 |  | 
|  | 343 | val = (unsigned char)tmp; | 
|  | 344 | spin_lock_irqsave(&event_lock, flags); | 
| mark gross | a09ab7e | 2006-06-23 15:13:07 -0700 | [diff] [blame] | 345 | SET_PORT_BITS(TLCLK_REG1, 0xdf, val << 1); | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 346 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 347 |  | 
|  | 348 | return strnlen(buf, count); | 
|  | 349 | } | 
|  | 350 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 351 | static DEVICE_ATTR(received_ref_clk3b, (S_IWUSR|S_IWGRP), NULL, | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 352 | store_received_ref_clk3b); | 
|  | 353 |  | 
|  | 354 |  | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 355 | static ssize_t store_enable_clk3b_output(struct device *d, | 
|  | 356 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 357 | { | 
|  | 358 | unsigned long tmp; | 
|  | 359 | unsigned char val; | 
|  | 360 | unsigned long flags; | 
|  | 361 |  | 
|  | 362 | sscanf(buf, "%lX", &tmp); | 
|  | 363 | dev_dbg(d, ": tmp = 0x%lX\n", tmp); | 
|  | 364 |  | 
|  | 365 | val = (unsigned char)tmp; | 
|  | 366 | spin_lock_irqsave(&event_lock, flags); | 
|  | 367 | SET_PORT_BITS(TLCLK_REG3, 0x7f, val << 7); | 
|  | 368 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 369 |  | 
|  | 370 | return strnlen(buf, count); | 
|  | 371 | } | 
|  | 372 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 373 | static DEVICE_ATTR(enable_clk3b_output, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 374 | store_enable_clk3b_output); | 
|  | 375 |  | 
|  | 376 | static ssize_t store_enable_clk3a_output(struct device *d, | 
|  | 377 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 378 | { | 
|  | 379 | unsigned long flags; | 
|  | 380 | unsigned long tmp; | 
|  | 381 | unsigned char val; | 
|  | 382 |  | 
|  | 383 | sscanf(buf, "%lX", &tmp); | 
|  | 384 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 385 |  | 
|  | 386 | val = (unsigned char)tmp; | 
|  | 387 | spin_lock_irqsave(&event_lock, flags); | 
|  | 388 | SET_PORT_BITS(TLCLK_REG3, 0xbf, val << 6); | 
|  | 389 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 390 |  | 
|  | 391 | return strnlen(buf, count); | 
|  | 392 | } | 
|  | 393 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 394 | static DEVICE_ATTR(enable_clk3a_output, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 395 | store_enable_clk3a_output); | 
|  | 396 |  | 
|  | 397 | static ssize_t store_enable_clkb1_output(struct device *d, | 
|  | 398 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 399 | { | 
|  | 400 | unsigned long flags; | 
|  | 401 | unsigned long tmp; | 
|  | 402 | unsigned char val; | 
|  | 403 |  | 
|  | 404 | sscanf(buf, "%lX", &tmp); | 
|  | 405 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 406 |  | 
|  | 407 | val = (unsigned char)tmp; | 
|  | 408 | spin_lock_irqsave(&event_lock, flags); | 
|  | 409 | SET_PORT_BITS(TLCLK_REG2, 0xf7, val << 3); | 
|  | 410 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 411 |  | 
|  | 412 | return strnlen(buf, count); | 
|  | 413 | } | 
|  | 414 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 415 | static DEVICE_ATTR(enable_clkb1_output, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 416 | store_enable_clkb1_output); | 
|  | 417 |  | 
|  | 418 |  | 
|  | 419 | static ssize_t store_enable_clka1_output(struct device *d, | 
|  | 420 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 421 | { | 
|  | 422 | unsigned long flags; | 
|  | 423 | unsigned long tmp; | 
|  | 424 | unsigned char val; | 
|  | 425 |  | 
|  | 426 | sscanf(buf, "%lX", &tmp); | 
|  | 427 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 428 |  | 
|  | 429 | val = (unsigned char)tmp; | 
|  | 430 | spin_lock_irqsave(&event_lock, flags); | 
|  | 431 | SET_PORT_BITS(TLCLK_REG2, 0xfb, val << 2); | 
|  | 432 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 433 |  | 
|  | 434 | return strnlen(buf, count); | 
|  | 435 | } | 
|  | 436 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 437 | static DEVICE_ATTR(enable_clka1_output, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 438 | store_enable_clka1_output); | 
|  | 439 |  | 
|  | 440 | static ssize_t store_enable_clkb0_output(struct device *d, | 
|  | 441 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 442 | { | 
|  | 443 | unsigned long flags; | 
|  | 444 | unsigned long tmp; | 
|  | 445 | unsigned char val; | 
|  | 446 |  | 
|  | 447 | sscanf(buf, "%lX", &tmp); | 
|  | 448 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 449 |  | 
|  | 450 | val = (unsigned char)tmp; | 
|  | 451 | spin_lock_irqsave(&event_lock, flags); | 
|  | 452 | SET_PORT_BITS(TLCLK_REG2, 0xfd, val << 1); | 
|  | 453 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 454 |  | 
|  | 455 | return strnlen(buf, count); | 
|  | 456 | } | 
|  | 457 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 458 | static DEVICE_ATTR(enable_clkb0_output, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 459 | store_enable_clkb0_output); | 
|  | 460 |  | 
|  | 461 | static ssize_t store_enable_clka0_output(struct device *d, | 
|  | 462 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 463 | { | 
|  | 464 | unsigned long flags; | 
|  | 465 | unsigned long tmp; | 
|  | 466 | unsigned char val; | 
|  | 467 |  | 
|  | 468 | sscanf(buf, "%lX", &tmp); | 
|  | 469 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 470 |  | 
|  | 471 | val = (unsigned char)tmp; | 
|  | 472 | spin_lock_irqsave(&event_lock, flags); | 
|  | 473 | SET_PORT_BITS(TLCLK_REG2, 0xfe, val); | 
|  | 474 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 475 |  | 
|  | 476 | return strnlen(buf, count); | 
|  | 477 | } | 
|  | 478 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 479 | static DEVICE_ATTR(enable_clka0_output, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 480 | store_enable_clka0_output); | 
|  | 481 |  | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 482 | static ssize_t store_select_amcb2_transmit_clock(struct device *d, | 
|  | 483 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 484 | { | 
|  | 485 | unsigned long flags; | 
|  | 486 | unsigned long tmp; | 
|  | 487 | unsigned char val; | 
|  | 488 |  | 
|  | 489 | sscanf(buf, "%lX", &tmp); | 
|  | 490 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 491 |  | 
|  | 492 | val = (unsigned char)tmp; | 
|  | 493 | spin_lock_irqsave(&event_lock, flags); | 
|  | 494 | if ((val == CLK_8kHz) || (val == CLK_16_384MHz)) { | 
|  | 495 | SET_PORT_BITS(TLCLK_REG3, 0xc7, 0x28); | 
|  | 496 | SET_PORT_BITS(TLCLK_REG1, 0xfb, ~val); | 
|  | 497 | } else if (val >= CLK_8_592MHz) { | 
|  | 498 | SET_PORT_BITS(TLCLK_REG3, 0xc7, 0x38); | 
|  | 499 | switch (val) { | 
|  | 500 | case CLK_8_592MHz: | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 501 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 2); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 502 | break; | 
|  | 503 | case CLK_11_184MHz: | 
|  | 504 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 0); | 
|  | 505 | break; | 
|  | 506 | case CLK_34_368MHz: | 
|  | 507 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 3); | 
|  | 508 | break; | 
|  | 509 | case CLK_44_736MHz: | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 510 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 1); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 511 | break; | 
|  | 512 | } | 
|  | 513 | } else | 
|  | 514 | SET_PORT_BITS(TLCLK_REG3, 0xc7, val << 3); | 
|  | 515 |  | 
|  | 516 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 517 |  | 
|  | 518 | return strnlen(buf, count); | 
|  | 519 | } | 
|  | 520 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 521 | static DEVICE_ATTR(select_amcb2_transmit_clock, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 522 | store_select_amcb2_transmit_clock); | 
|  | 523 |  | 
|  | 524 | static ssize_t store_select_amcb1_transmit_clock(struct device *d, | 
|  | 525 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 526 | { | 
|  | 527 | unsigned long tmp; | 
|  | 528 | unsigned char val; | 
|  | 529 | unsigned long flags; | 
|  | 530 |  | 
|  | 531 | sscanf(buf, "%lX", &tmp); | 
|  | 532 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 533 |  | 
|  | 534 | val = (unsigned char)tmp; | 
|  | 535 | spin_lock_irqsave(&event_lock, flags); | 
|  | 536 | if ((val == CLK_8kHz) || (val == CLK_16_384MHz)) { | 
|  | 537 | SET_PORT_BITS(TLCLK_REG3, 0xf8, 0x5); | 
|  | 538 | SET_PORT_BITS(TLCLK_REG1, 0xfb, ~val); | 
|  | 539 | } else if (val >= CLK_8_592MHz) { | 
|  | 540 | SET_PORT_BITS(TLCLK_REG3, 0xf8, 0x7); | 
|  | 541 | switch (val) { | 
|  | 542 | case CLK_8_592MHz: | 
|  | 543 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 1); | 
|  | 544 | break; | 
|  | 545 | case CLK_11_184MHz: | 
|  | 546 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 0); | 
|  | 547 | break; | 
|  | 548 | case CLK_34_368MHz: | 
|  | 549 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 3); | 
|  | 550 | break; | 
|  | 551 | case CLK_44_736MHz: | 
|  | 552 | SET_PORT_BITS(TLCLK_REG0, 0xfc, 2); | 
|  | 553 | break; | 
|  | 554 | } | 
|  | 555 | } else | 
|  | 556 | SET_PORT_BITS(TLCLK_REG3, 0xf8, val); | 
|  | 557 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 558 |  | 
|  | 559 | return strnlen(buf, count); | 
|  | 560 | } | 
|  | 561 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 562 | static DEVICE_ATTR(select_amcb1_transmit_clock, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 563 | store_select_amcb1_transmit_clock); | 
|  | 564 |  | 
|  | 565 | static ssize_t store_select_redundant_clock(struct device *d, | 
|  | 566 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 567 | { | 
|  | 568 | unsigned long tmp; | 
|  | 569 | unsigned char val; | 
|  | 570 | unsigned long flags; | 
|  | 571 |  | 
|  | 572 | sscanf(buf, "%lX", &tmp); | 
|  | 573 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 574 |  | 
|  | 575 | val = (unsigned char)tmp; | 
|  | 576 | spin_lock_irqsave(&event_lock, flags); | 
|  | 577 | SET_PORT_BITS(TLCLK_REG1, 0xfe, val); | 
|  | 578 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 579 |  | 
|  | 580 | return strnlen(buf, count); | 
|  | 581 | } | 
|  | 582 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 583 | static DEVICE_ATTR(select_redundant_clock, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 584 | store_select_redundant_clock); | 
|  | 585 |  | 
|  | 586 | static ssize_t store_select_ref_frequency(struct device *d, | 
|  | 587 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 588 | { | 
|  | 589 | unsigned long tmp; | 
|  | 590 | unsigned char val; | 
|  | 591 | unsigned long flags; | 
|  | 592 |  | 
|  | 593 | sscanf(buf, "%lX", &tmp); | 
|  | 594 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 595 |  | 
|  | 596 | val = (unsigned char)tmp; | 
|  | 597 | spin_lock_irqsave(&event_lock, flags); | 
|  | 598 | SET_PORT_BITS(TLCLK_REG1, 0xfd, val); | 
|  | 599 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 600 |  | 
|  | 601 | return strnlen(buf, count); | 
|  | 602 | } | 
|  | 603 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 604 | static DEVICE_ATTR(select_ref_frequency, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 605 | store_select_ref_frequency); | 
|  | 606 |  | 
|  | 607 | static ssize_t store_filter_select(struct device *d, | 
|  | 608 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 609 | { | 
|  | 610 | unsigned long tmp; | 
|  | 611 | unsigned char val; | 
|  | 612 | unsigned long flags; | 
|  | 613 |  | 
|  | 614 | sscanf(buf, "%lX", &tmp); | 
|  | 615 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 616 |  | 
|  | 617 | val = (unsigned char)tmp; | 
|  | 618 | spin_lock_irqsave(&event_lock, flags); | 
|  | 619 | SET_PORT_BITS(TLCLK_REG0, 0xfb, val); | 
|  | 620 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 621 |  | 
|  | 622 | return strnlen(buf, count); | 
|  | 623 | } | 
|  | 624 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 625 | static DEVICE_ATTR(filter_select, (S_IWUSR|S_IWGRP), NULL, store_filter_select); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 626 |  | 
|  | 627 | static ssize_t store_hardware_switching_mode(struct device *d, | 
|  | 628 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 629 | { | 
|  | 630 | unsigned long tmp; | 
|  | 631 | unsigned char val; | 
|  | 632 | unsigned long flags; | 
|  | 633 |  | 
|  | 634 | sscanf(buf, "%lX", &tmp); | 
|  | 635 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 636 |  | 
|  | 637 | val = (unsigned char)tmp; | 
|  | 638 | spin_lock_irqsave(&event_lock, flags); | 
|  | 639 | SET_PORT_BITS(TLCLK_REG0, 0xbf, val); | 
|  | 640 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 641 |  | 
|  | 642 | return strnlen(buf, count); | 
|  | 643 | } | 
|  | 644 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 645 | static DEVICE_ATTR(hardware_switching_mode, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 646 | store_hardware_switching_mode); | 
|  | 647 |  | 
|  | 648 | static ssize_t store_hardware_switching(struct device *d, | 
|  | 649 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 650 | { | 
|  | 651 | unsigned long tmp; | 
|  | 652 | unsigned char val; | 
|  | 653 | unsigned long flags; | 
|  | 654 |  | 
|  | 655 | sscanf(buf, "%lX", &tmp); | 
|  | 656 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 657 |  | 
|  | 658 | val = (unsigned char)tmp; | 
|  | 659 | spin_lock_irqsave(&event_lock, flags); | 
|  | 660 | SET_PORT_BITS(TLCLK_REG0, 0x7f, val); | 
|  | 661 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 662 |  | 
|  | 663 | return strnlen(buf, count); | 
|  | 664 | } | 
|  | 665 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 666 | static DEVICE_ATTR(hardware_switching, (S_IWUSR|S_IWGRP), NULL, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 667 | store_hardware_switching); | 
|  | 668 |  | 
|  | 669 | static ssize_t store_refalign (struct device *d, | 
|  | 670 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 671 | { | 
|  | 672 | unsigned long tmp; | 
|  | 673 | unsigned long flags; | 
|  | 674 |  | 
|  | 675 | sscanf(buf, "%lX", &tmp); | 
|  | 676 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 677 | spin_lock_irqsave(&event_lock, flags); | 
|  | 678 | SET_PORT_BITS(TLCLK_REG0, 0xf7, 0); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 679 | SET_PORT_BITS(TLCLK_REG0, 0xf7, 0x08); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 680 | SET_PORT_BITS(TLCLK_REG0, 0xf7, 0); | 
|  | 681 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 682 |  | 
|  | 683 | return strnlen(buf, count); | 
|  | 684 | } | 
|  | 685 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 686 | static DEVICE_ATTR(refalign, (S_IWUSR|S_IWGRP), NULL, store_refalign); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 687 |  | 
|  | 688 | static ssize_t store_mode_select (struct device *d, | 
|  | 689 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 690 | { | 
|  | 691 | unsigned long tmp; | 
|  | 692 | unsigned char val; | 
|  | 693 | unsigned long flags; | 
|  | 694 |  | 
|  | 695 | sscanf(buf, "%lX", &tmp); | 
|  | 696 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 697 |  | 
|  | 698 | val = (unsigned char)tmp; | 
|  | 699 | spin_lock_irqsave(&event_lock, flags); | 
|  | 700 | SET_PORT_BITS(TLCLK_REG0, 0xcf, val); | 
|  | 701 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 702 |  | 
|  | 703 | return strnlen(buf, count); | 
|  | 704 | } | 
|  | 705 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 706 | static DEVICE_ATTR(mode_select, (S_IWUSR|S_IWGRP), NULL, store_mode_select); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 707 |  | 
|  | 708 | static ssize_t store_reset (struct device *d, | 
|  | 709 | struct device_attribute *attr, const char *buf, size_t count) | 
|  | 710 | { | 
|  | 711 | unsigned long tmp; | 
|  | 712 | unsigned char val; | 
|  | 713 | unsigned long flags; | 
|  | 714 |  | 
|  | 715 | sscanf(buf, "%lX", &tmp); | 
|  | 716 | dev_dbg(d, "tmp = 0x%lX\n", tmp); | 
|  | 717 |  | 
|  | 718 | val = (unsigned char)tmp; | 
|  | 719 | spin_lock_irqsave(&event_lock, flags); | 
|  | 720 | SET_PORT_BITS(TLCLK_REG4, 0xfd, val); | 
|  | 721 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 722 |  | 
|  | 723 | return strnlen(buf, count); | 
|  | 724 | } | 
|  | 725 |  | 
| Mark Bellon | 31cc48b | 2006-04-10 22:54:20 -0700 | [diff] [blame] | 726 | static DEVICE_ATTR(reset, (S_IWUSR|S_IWGRP), NULL, store_reset); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 727 |  | 
|  | 728 | static struct attribute *tlclk_sysfs_entries[] = { | 
|  | 729 | &dev_attr_current_ref.attr, | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 730 | &dev_attr_telclock_version.attr, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 731 | &dev_attr_alarms.attr, | 
| mark gross | 648bf4f | 2006-01-15 17:37:30 -0800 | [diff] [blame] | 732 | &dev_attr_received_ref_clk3a.attr, | 
|  | 733 | &dev_attr_received_ref_clk3b.attr, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 734 | &dev_attr_enable_clk3a_output.attr, | 
|  | 735 | &dev_attr_enable_clk3b_output.attr, | 
|  | 736 | &dev_attr_enable_clkb1_output.attr, | 
|  | 737 | &dev_attr_enable_clka1_output.attr, | 
|  | 738 | &dev_attr_enable_clkb0_output.attr, | 
|  | 739 | &dev_attr_enable_clka0_output.attr, | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 740 | &dev_attr_select_amcb1_transmit_clock.attr, | 
|  | 741 | &dev_attr_select_amcb2_transmit_clock.attr, | 
|  | 742 | &dev_attr_select_redundant_clock.attr, | 
|  | 743 | &dev_attr_select_ref_frequency.attr, | 
|  | 744 | &dev_attr_filter_select.attr, | 
|  | 745 | &dev_attr_hardware_switching_mode.attr, | 
|  | 746 | &dev_attr_hardware_switching.attr, | 
|  | 747 | &dev_attr_refalign.attr, | 
|  | 748 | &dev_attr_mode_select.attr, | 
|  | 749 | &dev_attr_reset.attr, | 
|  | 750 | NULL | 
|  | 751 | }; | 
|  | 752 |  | 
|  | 753 | static struct attribute_group tlclk_attribute_group = { | 
|  | 754 | .name = NULL,		/* put in device directory */ | 
|  | 755 | .attrs = tlclk_sysfs_entries, | 
|  | 756 | }; | 
|  | 757 |  | 
|  | 758 | static struct platform_device *tlclk_device; | 
|  | 759 |  | 
|  | 760 | static int __init tlclk_init(void) | 
|  | 761 | { | 
|  | 762 | int ret; | 
|  | 763 |  | 
|  | 764 | ret = register_chrdev(tlclk_major, "telco_clock", &tlclk_fops); | 
|  | 765 | if (ret < 0) { | 
| Alan Cox | 4ab2495 | 2006-01-11 12:17:33 -0800 | [diff] [blame] | 766 | printk(KERN_ERR "tlclk: can't get major %d.\n", tlclk_major); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 767 | return ret; | 
|  | 768 | } | 
| Andrew Morton | 222b9f9 | 2006-03-26 01:37:31 -0800 | [diff] [blame] | 769 | tlclk_major = ret; | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 770 | alarm_events = kzalloc( sizeof(struct tlclk_alarms), GFP_KERNEL); | 
|  | 771 | if (!alarm_events) | 
|  | 772 | goto out1; | 
|  | 773 |  | 
|  | 774 | /* Read telecom clock IRQ number (Set by BIOS) */ | 
|  | 775 | if (!request_region(TLCLK_BASE, 8, "telco_clock")) { | 
| Alan Cox | 4ab2495 | 2006-01-11 12:17:33 -0800 | [diff] [blame] | 776 | printk(KERN_ERR "tlclk: request_region 0x%X failed.\n", | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 777 | TLCLK_BASE); | 
|  | 778 | ret = -EBUSY; | 
|  | 779 | goto out2; | 
|  | 780 | } | 
|  | 781 | telclk_interrupt = (inb(TLCLK_REG7) & 0x0f); | 
|  | 782 |  | 
|  | 783 | if (0x0F == telclk_interrupt ) { /* not MCPBL0010 ? */ | 
| Alan Cox | 4ab2495 | 2006-01-11 12:17:33 -0800 | [diff] [blame] | 784 | printk(KERN_ERR "telclk_interrup = 0x%x non-mcpbl0010 hw.\n", | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 785 | telclk_interrupt); | 
|  | 786 | ret = -ENXIO; | 
|  | 787 | goto out3; | 
|  | 788 | } | 
|  | 789 |  | 
|  | 790 | init_timer(&switchover_timer); | 
|  | 791 |  | 
|  | 792 | ret = misc_register(&tlclk_miscdev); | 
|  | 793 | if (ret < 0) { | 
| Alan Cox | 4ab2495 | 2006-01-11 12:17:33 -0800 | [diff] [blame] | 794 | printk(KERN_ERR "tlclk: misc_register returns %d.\n", ret); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 795 | ret = -EBUSY; | 
|  | 796 | goto out3; | 
|  | 797 | } | 
|  | 798 |  | 
|  | 799 | tlclk_device = platform_device_register_simple("telco_clock", | 
|  | 800 | -1, NULL, 0); | 
|  | 801 | if (!tlclk_device) { | 
| Alan Cox | 4ab2495 | 2006-01-11 12:17:33 -0800 | [diff] [blame] | 802 | printk(KERN_ERR "tlclk: platform_device_register failed.\n"); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 803 | ret = -EBUSY; | 
|  | 804 | goto out4; | 
|  | 805 | } | 
|  | 806 |  | 
|  | 807 | ret = sysfs_create_group(&tlclk_device->dev.kobj, | 
|  | 808 | &tlclk_attribute_group); | 
|  | 809 | if (ret) { | 
| Alan Cox | 4ab2495 | 2006-01-11 12:17:33 -0800 | [diff] [blame] | 810 | printk(KERN_ERR "tlclk: failed to create sysfs device attributes.\n"); | 
| Mark Gross | 1a80ba8 | 2005-10-30 15:02:55 -0800 | [diff] [blame] | 811 | sysfs_remove_group(&tlclk_device->dev.kobj, | 
|  | 812 | &tlclk_attribute_group); | 
|  | 813 | goto out5; | 
|  | 814 | } | 
|  | 815 |  | 
|  | 816 | return 0; | 
|  | 817 | out5: | 
|  | 818 | platform_device_unregister(tlclk_device); | 
|  | 819 | out4: | 
|  | 820 | misc_deregister(&tlclk_miscdev); | 
|  | 821 | out3: | 
|  | 822 | release_region(TLCLK_BASE, 8); | 
|  | 823 | out2: | 
|  | 824 | kfree(alarm_events); | 
|  | 825 | out1: | 
|  | 826 | unregister_chrdev(tlclk_major, "telco_clock"); | 
|  | 827 | return ret; | 
|  | 828 | } | 
|  | 829 |  | 
|  | 830 | static void __exit tlclk_cleanup(void) | 
|  | 831 | { | 
|  | 832 | sysfs_remove_group(&tlclk_device->dev.kobj, &tlclk_attribute_group); | 
|  | 833 | platform_device_unregister(tlclk_device); | 
|  | 834 | misc_deregister(&tlclk_miscdev); | 
|  | 835 | unregister_chrdev(tlclk_major, "telco_clock"); | 
|  | 836 |  | 
|  | 837 | release_region(TLCLK_BASE, 8); | 
|  | 838 | del_timer_sync(&switchover_timer); | 
|  | 839 | kfree(alarm_events); | 
|  | 840 |  | 
|  | 841 | } | 
|  | 842 |  | 
|  | 843 | static void switchover_timeout(unsigned long data) | 
|  | 844 | { | 
|  | 845 | if ((data & 1)) { | 
|  | 846 | if ((inb(TLCLK_REG1) & 0x08) != (data & 0x08)) | 
|  | 847 | alarm_events->switchover_primary++; | 
|  | 848 | } else { | 
|  | 849 | if ((inb(TLCLK_REG1) & 0x08) != (data & 0x08)) | 
|  | 850 | alarm_events->switchover_secondary++; | 
|  | 851 | } | 
|  | 852 |  | 
|  | 853 | /* Alarm processing is done, wake up read task */ | 
|  | 854 | del_timer(&switchover_timer); | 
|  | 855 | got_event = 1; | 
|  | 856 | wake_up(&wq); | 
|  | 857 | } | 
|  | 858 |  | 
|  | 859 | static irqreturn_t tlclk_interrupt(int irq, void *dev_id, struct pt_regs *regs) | 
|  | 860 | { | 
|  | 861 | unsigned long flags; | 
|  | 862 |  | 
|  | 863 | spin_lock_irqsave(&event_lock, flags); | 
|  | 864 | /* Read and clear interrupt events */ | 
|  | 865 | int_events = inb(TLCLK_REG6); | 
|  | 866 |  | 
|  | 867 | /* Primary_Los changed from 0 to 1 ? */ | 
|  | 868 | if (int_events & PRI_LOS_01_MASK) { | 
|  | 869 | if (inb(TLCLK_REG2) & SEC_LOST_MASK) | 
|  | 870 | alarm_events->lost_clocks++; | 
|  | 871 | else | 
|  | 872 | alarm_events->lost_primary_clock++; | 
|  | 873 | } | 
|  | 874 |  | 
|  | 875 | /* Primary_Los changed from 1 to 0 ? */ | 
|  | 876 | if (int_events & PRI_LOS_10_MASK) { | 
|  | 877 | alarm_events->primary_clock_back++; | 
|  | 878 | SET_PORT_BITS(TLCLK_REG1, 0xFE, 1); | 
|  | 879 | } | 
|  | 880 | /* Secondary_Los changed from 0 to 1 ? */ | 
|  | 881 | if (int_events & SEC_LOS_01_MASK) { | 
|  | 882 | if (inb(TLCLK_REG2) & PRI_LOST_MASK) | 
|  | 883 | alarm_events->lost_clocks++; | 
|  | 884 | else | 
|  | 885 | alarm_events->lost_secondary_clock++; | 
|  | 886 | } | 
|  | 887 | /* Secondary_Los changed from 1 to 0 ? */ | 
|  | 888 | if (int_events & SEC_LOS_10_MASK) { | 
|  | 889 | alarm_events->secondary_clock_back++; | 
|  | 890 | SET_PORT_BITS(TLCLK_REG1, 0xFE, 0); | 
|  | 891 | } | 
|  | 892 | if (int_events & HOLDOVER_10_MASK) | 
|  | 893 | alarm_events->pll_end_holdover++; | 
|  | 894 |  | 
|  | 895 | if (int_events & UNLOCK_01_MASK) | 
|  | 896 | alarm_events->pll_lost_sync++; | 
|  | 897 |  | 
|  | 898 | if (int_events & UNLOCK_10_MASK) | 
|  | 899 | alarm_events->pll_sync++; | 
|  | 900 |  | 
|  | 901 | /* Holdover changed from 0 to 1 ? */ | 
|  | 902 | if (int_events & HOLDOVER_01_MASK) { | 
|  | 903 | alarm_events->pll_holdover++; | 
|  | 904 |  | 
|  | 905 | /* TIMEOUT in ~10ms */ | 
|  | 906 | switchover_timer.expires = jiffies + msecs_to_jiffies(10); | 
|  | 907 | switchover_timer.data = inb(TLCLK_REG1); | 
|  | 908 | add_timer(&switchover_timer); | 
|  | 909 | } else { | 
|  | 910 | got_event = 1; | 
|  | 911 | wake_up(&wq); | 
|  | 912 | } | 
|  | 913 | spin_unlock_irqrestore(&event_lock, flags); | 
|  | 914 |  | 
|  | 915 | return IRQ_HANDLED; | 
|  | 916 | } | 
|  | 917 |  | 
|  | 918 | module_init(tlclk_init); | 
|  | 919 | module_exit(tlclk_cleanup); |