PRCM: 34XX: Fix wrong shift value used in dpll4_m4x2_ck enable bit
[linux-ginger.git] / arch / ia64 / sn / kernel / tiocx.c
bloba88eba3314d7fb02b812c7b8cf5055788da90fa4
1 /*
2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
4 * for more details.
6 * Copyright (c) 2005 Silicon Graphics, Inc. All rights reserved.
7 */
9 #include <linux/module.h>
10 #include <linux/kernel.h>
11 #include <linux/slab.h>
12 #include <linux/spinlock.h>
13 #include <linux/proc_fs.h>
14 #include <linux/capability.h>
15 #include <linux/device.h>
16 #include <linux/delay.h>
17 #include <asm/system.h>
18 #include <asm/uaccess.h>
19 #include <asm/sn/sn_sal.h>
20 #include <asm/sn/addrs.h>
21 #include <asm/sn/io.h>
22 #include <asm/sn/types.h>
23 #include <asm/sn/shubio.h>
24 #include <asm/sn/tiocx.h>
25 #include <asm/sn/l1.h>
26 #include <asm/sn/module.h>
27 #include "tio.h"
28 #include "xtalk/xwidgetdev.h"
29 #include "xtalk/hubdev.h"
31 #define CX_DEV_NONE 0
32 #define DEVICE_NAME "tiocx"
33 #define WIDGET_ID 0
34 #define TIOCX_DEBUG 0
36 #if TIOCX_DEBUG
37 #define DBG(fmt...) printk(KERN_ALERT fmt)
38 #else
39 #define DBG(fmt...)
40 #endif
42 struct device_attribute dev_attr_cxdev_control;
44 /**
45 * tiocx_match - Try to match driver id list with device.
46 * @dev: device pointer
47 * @drv: driver pointer
49 * Returns 1 if match, 0 otherwise.
51 static int tiocx_match(struct device *dev, struct device_driver *drv)
53 struct cx_dev *cx_dev = to_cx_dev(dev);
54 struct cx_drv *cx_drv = to_cx_driver(drv);
55 const struct cx_device_id *ids = cx_drv->id_table;
57 if (!ids)
58 return 0;
60 while (ids->part_num) {
61 if (ids->part_num == cx_dev->cx_id.part_num)
62 return 1;
63 ids++;
65 return 0;
69 static int tiocx_uevent(struct device *dev, struct kobj_uevent_env *env)
71 return -ENODEV;
74 static void tiocx_bus_release(struct device *dev)
76 kfree(to_cx_dev(dev));
79 /**
80 * cx_device_match - Find cx_device in the id table.
81 * @ids: id table from driver
82 * @cx_device: part/mfg id for the device
85 static const struct cx_device_id *cx_device_match(const struct cx_device_id
86 *ids,
87 struct cx_dev *cx_device)
90 * NOTES: We may want to check for CX_ANY_ID too.
91 * Do we want to match against nasid too?
92 * CX_DEV_NONE == 0, if the driver tries to register for
93 * part/mfg == 0 we should return no-match (NULL) here.
95 while (ids->part_num && ids->mfg_num) {
96 if (ids->part_num == cx_device->cx_id.part_num &&
97 ids->mfg_num == cx_device->cx_id.mfg_num)
98 return ids;
99 ids++;
102 return NULL;
106 * cx_device_probe - Look for matching device.
107 * Call driver probe routine if found.
108 * @cx_driver: driver table (cx_drv struct) from driver
109 * @cx_device: part/mfg id for the device
111 static int cx_device_probe(struct device *dev)
113 const struct cx_device_id *id;
114 struct cx_drv *cx_drv = to_cx_driver(dev->driver);
115 struct cx_dev *cx_dev = to_cx_dev(dev);
116 int error = 0;
118 if (!cx_dev->driver && cx_drv->probe) {
119 id = cx_device_match(cx_drv->id_table, cx_dev);
120 if (id) {
121 if ((error = cx_drv->probe(cx_dev, id)) < 0)
122 return error;
123 else
124 cx_dev->driver = cx_drv;
128 return error;
132 * cx_driver_remove - Remove driver from device struct.
133 * @dev: device
135 static int cx_driver_remove(struct device *dev)
137 struct cx_dev *cx_dev = to_cx_dev(dev);
138 struct cx_drv *cx_drv = cx_dev->driver;
139 if (cx_drv->remove)
140 cx_drv->remove(cx_dev);
141 cx_dev->driver = NULL;
142 return 0;
145 struct bus_type tiocx_bus_type = {
146 .name = "tiocx",
147 .match = tiocx_match,
148 .uevent = tiocx_uevent,
149 .probe = cx_device_probe,
150 .remove = cx_driver_remove,
154 * cx_driver_register - Register the driver.
155 * @cx_driver: driver table (cx_drv struct) from driver
157 * Called from the driver init routine to register a driver.
158 * The cx_drv struct contains the driver name, a pointer to
159 * a table of part/mfg numbers and a pointer to the driver's
160 * probe/attach routine.
162 int cx_driver_register(struct cx_drv *cx_driver)
164 cx_driver->driver.name = cx_driver->name;
165 cx_driver->driver.bus = &tiocx_bus_type;
167 return driver_register(&cx_driver->driver);
171 * cx_driver_unregister - Unregister the driver.
172 * @cx_driver: driver table (cx_drv struct) from driver
174 int cx_driver_unregister(struct cx_drv *cx_driver)
176 driver_unregister(&cx_driver->driver);
177 return 0;
181 * cx_device_register - Register a device.
182 * @nasid: device's nasid
183 * @part_num: device's part number
184 * @mfg_num: device's manufacturer number
185 * @hubdev: hub info associated with this device
186 * @bt: board type of the device
190 cx_device_register(nasid_t nasid, int part_num, int mfg_num,
191 struct hubdev_info *hubdev, int bt)
193 struct cx_dev *cx_dev;
195 cx_dev = kzalloc(sizeof(struct cx_dev), GFP_KERNEL);
196 DBG("cx_dev= 0x%p\n", cx_dev);
197 if (cx_dev == NULL)
198 return -ENOMEM;
200 cx_dev->cx_id.part_num = part_num;
201 cx_dev->cx_id.mfg_num = mfg_num;
202 cx_dev->cx_id.nasid = nasid;
203 cx_dev->hubdev = hubdev;
204 cx_dev->bt = bt;
206 cx_dev->dev.parent = NULL;
207 cx_dev->dev.bus = &tiocx_bus_type;
208 cx_dev->dev.release = tiocx_bus_release;
209 snprintf(cx_dev->dev.bus_id, BUS_ID_SIZE, "%d",
210 cx_dev->cx_id.nasid);
211 device_register(&cx_dev->dev);
212 get_device(&cx_dev->dev);
214 device_create_file(&cx_dev->dev, &dev_attr_cxdev_control);
216 return 0;
220 * cx_device_unregister - Unregister a device.
221 * @cx_dev: part/mfg id for the device
223 int cx_device_unregister(struct cx_dev *cx_dev)
225 put_device(&cx_dev->dev);
226 device_unregister(&cx_dev->dev);
227 return 0;
231 * cx_device_reload - Reload the device.
232 * @nasid: device's nasid
233 * @part_num: device's part number
234 * @mfg_num: device's manufacturer number
236 * Remove the device associated with 'nasid' from device list and then
237 * call device-register with the given part/mfg numbers.
239 static int cx_device_reload(struct cx_dev *cx_dev)
241 cx_device_unregister(cx_dev);
242 return cx_device_register(cx_dev->cx_id.nasid, cx_dev->cx_id.part_num,
243 cx_dev->cx_id.mfg_num, cx_dev->hubdev,
244 cx_dev->bt);
247 static inline u64 tiocx_intr_alloc(nasid_t nasid, int widget,
248 u64 sn_irq_info,
249 int req_irq, nasid_t req_nasid,
250 int req_slice)
252 struct ia64_sal_retval rv;
253 rv.status = 0;
254 rv.v0 = 0;
256 ia64_sal_oemcall_nolock(&rv, SN_SAL_IOIF_INTERRUPT,
257 SAL_INTR_ALLOC, nasid,
258 widget, sn_irq_info, req_irq,
259 req_nasid, req_slice);
260 return rv.status;
263 static inline void tiocx_intr_free(nasid_t nasid, int widget,
264 struct sn_irq_info *sn_irq_info)
266 struct ia64_sal_retval rv;
267 rv.status = 0;
268 rv.v0 = 0;
270 ia64_sal_oemcall_nolock(&rv, SN_SAL_IOIF_INTERRUPT,
271 SAL_INTR_FREE, nasid,
272 widget, sn_irq_info->irq_irq,
273 sn_irq_info->irq_cookie, 0, 0);
276 struct sn_irq_info *tiocx_irq_alloc(nasid_t nasid, int widget, int irq,
277 nasid_t req_nasid, int slice)
279 struct sn_irq_info *sn_irq_info;
280 int status;
281 int sn_irq_size = sizeof(struct sn_irq_info);
283 if ((nasid & 1) == 0)
284 return NULL;
286 sn_irq_info = kzalloc(sn_irq_size, GFP_KERNEL);
287 if (sn_irq_info == NULL)
288 return NULL;
290 status = tiocx_intr_alloc(nasid, widget, __pa(sn_irq_info), irq,
291 req_nasid, slice);
292 if (status) {
293 kfree(sn_irq_info);
294 return NULL;
295 } else {
296 return sn_irq_info;
300 void tiocx_irq_free(struct sn_irq_info *sn_irq_info)
302 u64 bridge = (u64) sn_irq_info->irq_bridge;
303 nasid_t nasid = NASID_GET(bridge);
304 int widget;
306 if (nasid & 1) {
307 widget = TIO_SWIN_WIDGETNUM(bridge);
308 tiocx_intr_free(nasid, widget, sn_irq_info);
309 kfree(sn_irq_info);
313 u64 tiocx_dma_addr(u64 addr)
315 return PHYS_TO_TIODMA(addr);
318 u64 tiocx_swin_base(int nasid)
320 return TIO_SWIN_BASE(nasid, TIOCX_CORELET);
323 EXPORT_SYMBOL(cx_driver_register);
324 EXPORT_SYMBOL(cx_driver_unregister);
325 EXPORT_SYMBOL(cx_device_register);
326 EXPORT_SYMBOL(cx_device_unregister);
327 EXPORT_SYMBOL(tiocx_irq_alloc);
328 EXPORT_SYMBOL(tiocx_irq_free);
329 EXPORT_SYMBOL(tiocx_bus_type);
330 EXPORT_SYMBOL(tiocx_dma_addr);
331 EXPORT_SYMBOL(tiocx_swin_base);
333 static void tio_conveyor_set(nasid_t nasid, int enable_flag)
335 u64 ice_frz;
336 u64 disable_cb = (1ull << 61);
338 if (!(nasid & 1))
339 return;
341 ice_frz = REMOTE_HUB_L(nasid, TIO_ICE_FRZ_CFG);
342 if (enable_flag) {
343 if (!(ice_frz & disable_cb)) /* already enabled */
344 return;
345 ice_frz &= ~disable_cb;
346 } else {
347 if (ice_frz & disable_cb) /* already disabled */
348 return;
349 ice_frz |= disable_cb;
351 DBG(KERN_ALERT "TIO_ICE_FRZ_CFG= 0x%lx\n", ice_frz);
352 REMOTE_HUB_S(nasid, TIO_ICE_FRZ_CFG, ice_frz);
355 #define tio_conveyor_enable(nasid) tio_conveyor_set(nasid, 1)
356 #define tio_conveyor_disable(nasid) tio_conveyor_set(nasid, 0)
358 static void tio_corelet_reset(nasid_t nasid, int corelet)
360 if (!(nasid & 1))
361 return;
363 REMOTE_HUB_S(nasid, TIO_ICE_PMI_TX_CFG, 1 << corelet);
364 udelay(2000);
365 REMOTE_HUB_S(nasid, TIO_ICE_PMI_TX_CFG, 0);
366 udelay(2000);
369 static int is_fpga_tio(int nasid, int *bt)
371 u16 uninitialized_var(ioboard_type); /* GCC be quiet */
372 s64 rc;
374 rc = ia64_sn_sysctl_ioboard_get(nasid, &ioboard_type);
375 if (rc) {
376 printk(KERN_WARNING "ia64_sn_sysctl_ioboard_get failed: %ld\n",
377 rc);
378 return 0;
381 switch (ioboard_type) {
382 case L1_BRICKTYPE_SA:
383 case L1_BRICKTYPE_ATHENA:
384 case L1_BOARDTYPE_DAYTONA:
385 *bt = ioboard_type;
386 return 1;
389 return 0;
392 static int bitstream_loaded(nasid_t nasid)
394 u64 cx_credits;
396 cx_credits = REMOTE_HUB_L(nasid, TIO_ICE_PMI_TX_DYN_CREDIT_STAT_CB3);
397 cx_credits &= TIO_ICE_PMI_TX_DYN_CREDIT_STAT_CB3_CREDIT_CNT_MASK;
398 DBG("cx_credits= 0x%lx\n", cx_credits);
400 return (cx_credits == 0xf) ? 1 : 0;
403 static int tiocx_reload(struct cx_dev *cx_dev)
405 int part_num = CX_DEV_NONE;
406 int mfg_num = CX_DEV_NONE;
407 nasid_t nasid = cx_dev->cx_id.nasid;
409 if (bitstream_loaded(nasid)) {
410 u64 cx_id;
411 int rv;
413 rv = ia64_sn_sysctl_tio_clock_reset(nasid);
414 if (rv) {
415 printk(KERN_ALERT "CX port JTAG reset failed.\n");
416 } else {
417 cx_id = *(volatile u64 *)
418 (TIO_SWIN_BASE(nasid, TIOCX_CORELET) +
419 WIDGET_ID);
420 part_num = XWIDGET_PART_NUM(cx_id);
421 mfg_num = XWIDGET_MFG_NUM(cx_id);
422 DBG("part= 0x%x, mfg= 0x%x\n", part_num, mfg_num);
423 /* just ignore it if it's a CE */
424 if (part_num == TIO_CE_ASIC_PARTNUM)
425 return 0;
429 cx_dev->cx_id.part_num = part_num;
430 cx_dev->cx_id.mfg_num = mfg_num;
433 * Delete old device and register the new one. It's ok if
434 * part_num/mfg_num == CX_DEV_NONE. We want to register
435 * devices in the table even if a bitstream isn't loaded.
436 * That allows use to see that a bitstream isn't loaded via
437 * TIOCX_IOCTL_DEV_LIST.
439 return cx_device_reload(cx_dev);
442 static ssize_t show_cxdev_control(struct device *dev, struct device_attribute *attr, char *buf)
444 struct cx_dev *cx_dev = to_cx_dev(dev);
446 return sprintf(buf, "0x%x 0x%x 0x%x 0x%x\n",
447 cx_dev->cx_id.nasid,
448 cx_dev->cx_id.part_num, cx_dev->cx_id.mfg_num,
449 cx_dev->bt);
452 static ssize_t store_cxdev_control(struct device *dev, struct device_attribute *attr, const char *buf,
453 size_t count)
455 int n;
456 struct cx_dev *cx_dev = to_cx_dev(dev);
458 if (!capable(CAP_SYS_ADMIN))
459 return -EPERM;
461 if (count <= 0)
462 return 0;
464 n = simple_strtoul(buf, NULL, 0);
466 switch (n) {
467 case 1:
468 tio_corelet_reset(cx_dev->cx_id.nasid, TIOCX_CORELET);
469 tiocx_reload(cx_dev);
470 break;
471 case 2:
472 tiocx_reload(cx_dev);
473 break;
474 case 3:
475 tio_corelet_reset(cx_dev->cx_id.nasid, TIOCX_CORELET);
476 break;
477 default:
478 break;
481 return count;
484 DEVICE_ATTR(cxdev_control, 0644, show_cxdev_control, store_cxdev_control);
486 static int __init tiocx_init(void)
488 cnodeid_t cnodeid;
489 int found_tiocx_device = 0;
491 if (!ia64_platform_is("sn2"))
492 return 0;
494 bus_register(&tiocx_bus_type);
496 for (cnodeid = 0; cnodeid < num_cnodes; cnodeid++) {
497 nasid_t nasid;
498 int bt;
500 nasid = cnodeid_to_nasid(cnodeid);
502 if ((nasid & 0x1) && is_fpga_tio(nasid, &bt)) {
503 struct hubdev_info *hubdev;
504 struct xwidget_info *widgetp;
506 DBG("Found TIO at nasid 0x%x\n", nasid);
508 hubdev =
509 (struct hubdev_info *)(NODEPDA(cnodeid)->pdinfo);
511 widgetp = &hubdev->hdi_xwidget_info[TIOCX_CORELET];
513 /* The CE hangs off of the CX port but is not an FPGA */
514 if (widgetp->xwi_hwid.part_num == TIO_CE_ASIC_PARTNUM)
515 continue;
517 tio_corelet_reset(nasid, TIOCX_CORELET);
518 tio_conveyor_enable(nasid);
520 if (cx_device_register
521 (nasid, widgetp->xwi_hwid.part_num,
522 widgetp->xwi_hwid.mfg_num, hubdev, bt) < 0)
523 return -ENXIO;
524 else
525 found_tiocx_device++;
529 /* It's ok if we find zero devices. */
530 DBG("found_tiocx_device= %d\n", found_tiocx_device);
532 return 0;
535 static int cx_remove_device(struct device * dev, void * data)
537 struct cx_dev *cx_dev = to_cx_dev(dev);
538 device_remove_file(dev, &dev_attr_cxdev_control);
539 cx_device_unregister(cx_dev);
540 return 0;
543 static void __exit tiocx_exit(void)
545 DBG("tiocx_exit\n");
548 * Unregister devices.
550 bus_for_each_dev(&tiocx_bus_type, NULL, NULL, cx_remove_device);
551 bus_unregister(&tiocx_bus_type);
554 fs_initcall(tiocx_init);
555 module_exit(tiocx_exit);
557 /************************************************************************
558 * Module licensing and description
559 ************************************************************************/
560 MODULE_LICENSE("GPL");
561 MODULE_AUTHOR("Bruce Losure <blosure@sgi.com>");
562 MODULE_DESCRIPTION("TIOCX module");
563 MODULE_SUPPORTED_DEVICE(DEVICE_NAME);