git.oblomov.eu Git - linux-2.6/blob - arch/ia64/sn/kernel/tiocx.c

   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.
   5  *
   6  * Copyright (c) 2005 Silicon Graphics, Inc.  All rights reserved.
   7  */
   8
   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"
  30
  31 #define CX_DEV_NONE 0
  32 #define DEVICE_NAME "tiocx"
  33 #define WIDGET_ID 0
  34 #define TIOCX_DEBUG 0
  35
  36 #if TIOCX_DEBUG
  37 #define DBG(fmt...)    printk(KERN_ALERT fmt)
  38 #else
  39 #define DBG(fmt...)
  40 #endif
  41
  42 struct device_attribute dev_attr_cxdev_control;
  43
  44 /**
  45  * tiocx_match - Try to match driver id list with device.
  46  * @dev: device pointer
  47  * @drv: driver pointer
  48  *
  49  * Returns 1 if match, 0 otherwise.
  50  */
  51 static int tiocx_match(struct device *dev, struct device_driver *drv)
  52 {
  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;
  56
  57         if (!ids)
  58                 return 0;
  59
  60         while (ids->part_num) {
  61                 if (ids->part_num == cx_dev->cx_id.part_num)
  62                         return 1;
  63                 ids++;
  64         }
  65         return 0;
  66
  67 }
  68
  69 static int tiocx_uevent(struct device *dev, char **envp, int num_envp,
  70                          char *buffer, int buffer_size)
  71 {
  72         return -ENODEV;
  73 }
  74
  75 static void tiocx_bus_release(struct device *dev)
  76 {
  77         kfree(to_cx_dev(dev));
  78 }
  79
  80 /**
  81  * cx_device_match - Find cx_device in the id table.
  82  * @ids: id table from driver
  83  * @cx_device: part/mfg id for the device
  84  *
  85  */
  86 static const struct cx_device_id *cx_device_match(const struct cx_device_id
  87                                                   *ids,
  88                                                   struct cx_dev *cx_device)
  89 {
  90         /*
  91          * NOTES: We may want to check for CX_ANY_ID too.
  92          *        Do we want to match against nasid too?
  93          *        CX_DEV_NONE == 0, if the driver tries to register for
  94          *        part/mfg == 0 we should return no-match (NULL) here.
  95          */
  96         while (ids->part_num && ids->mfg_num) {
  97                 if (ids->part_num == cx_device->cx_id.part_num &&
  98                     ids->mfg_num == cx_device->cx_id.mfg_num)
  99                         return ids;
 100                 ids++;
 101         }
 102
 103         return NULL;
 104 }
 105
 106 /**
 107  * cx_device_probe - Look for matching device.
 108  *                      Call driver probe routine if found.
 109  * @cx_driver: driver table (cx_drv struct) from driver
 110  * @cx_device: part/mfg id for the device
 111  */
 112 static int cx_device_probe(struct device *dev)
 113 {
 114         const struct cx_device_id *id;
 115         struct cx_drv *cx_drv = to_cx_driver(dev->driver);
 116         struct cx_dev *cx_dev = to_cx_dev(dev);
 117         int error = 0;
 118
 119         if (!cx_dev->driver && cx_drv->probe) {
 120                 id = cx_device_match(cx_drv->id_table, cx_dev);
 121                 if (id) {
 122                         if ((error = cx_drv->probe(cx_dev, id)) < 0)
 123                                 return error;
 124                         else
 125                                 cx_dev->driver = cx_drv;
 126                 }
 127         }
 128
 129         return error;
 130 }
 131
 132 /**
 133  * cx_driver_remove - Remove driver from device struct.
 134  * @dev: device
 135  */
 136 static int cx_driver_remove(struct device *dev)
 137 {
 138         struct cx_dev *cx_dev = to_cx_dev(dev);
 139         struct cx_drv *cx_drv = cx_dev->driver;
 140         if (cx_drv->remove)
 141                 cx_drv->remove(cx_dev);
 142         cx_dev->driver = NULL;
 143         return 0;
 144 }
 145
 146 struct bus_type tiocx_bus_type = {
 147         .name = "tiocx",
 148         .match = tiocx_match,
 149         .uevent = tiocx_uevent,
 150         .probe = cx_device_probe,
 151         .remove = cx_driver_remove,
 152 };
 153
 154 /**
 155  * cx_driver_register - Register the driver.
 156  * @cx_driver: driver table (cx_drv struct) from driver
 157  *
 158  * Called from the driver init routine to register a driver.
 159  * The cx_drv struct contains the driver name, a pointer to
 160  * a table of part/mfg numbers and a pointer to the driver's
 161  * probe/attach routine.
 162  */
 163 int cx_driver_register(struct cx_drv *cx_driver)
 164 {
 165         cx_driver->driver.name = cx_driver->name;
 166         cx_driver->driver.bus = &tiocx_bus_type;
 167
 168         return driver_register(&cx_driver->driver);
 169 }
 170
 171 /**
 172  * cx_driver_unregister - Unregister the driver.
 173  * @cx_driver: driver table (cx_drv struct) from driver
 174  */
 175 int cx_driver_unregister(struct cx_drv *cx_driver)
 176 {
 177         driver_unregister(&cx_driver->driver);
 178         return 0;
 179 }
 180
 181 /**
 182  * cx_device_register - Register a device.
 183  * @nasid: device's nasid
 184  * @part_num: device's part number
 185  * @mfg_num: device's manufacturer number
 186  * @hubdev: hub info associated with this device
 187  * @bt: board type of the device
 188  *
 189  */
 190 int
 191 cx_device_register(nasid_t nasid, int part_num, int mfg_num,
 192                    struct hubdev_info *hubdev, int bt)
 193 {
 194         struct cx_dev *cx_dev;
 195
 196         cx_dev = kzalloc(sizeof(struct cx_dev), GFP_KERNEL);
 197         DBG("cx_dev= 0x%p\n", cx_dev);
 198         if (cx_dev == NULL)
 199                 return -ENOMEM;
 200
 201         cx_dev->cx_id.part_num = part_num;
 202         cx_dev->cx_id.mfg_num = mfg_num;
 203         cx_dev->cx_id.nasid = nasid;
 204         cx_dev->hubdev = hubdev;
 205         cx_dev->bt = bt;
 206
 207         cx_dev->dev.parent = NULL;
 208         cx_dev->dev.bus = &tiocx_bus_type;
 209         cx_dev->dev.release = tiocx_bus_release;
 210         snprintf(cx_dev->dev.bus_id, BUS_ID_SIZE, "%d",
 211                  cx_dev->cx_id.nasid);
 212         device_register(&cx_dev->dev);
 213         get_device(&cx_dev->dev);
 214
 215         device_create_file(&cx_dev->dev, &dev_attr_cxdev_control);
 216
 217         return 0;
 218 }
 219
 220 /**
 221  * cx_device_unregister - Unregister a device.
 222  * @cx_dev: part/mfg id for the device
 223  */
 224 int cx_device_unregister(struct cx_dev *cx_dev)
 225 {
 226         put_device(&cx_dev->dev);
 227         device_unregister(&cx_dev->dev);
 228         return 0;
 229 }
 230
 231 /**
 232  * cx_device_reload - Reload the device.
 233  * @nasid: device's nasid
 234  * @part_num: device's part number
 235  * @mfg_num: device's manufacturer number
 236  *
 237  * Remove the device associated with 'nasid' from device list and then
 238  * call device-register with the given part/mfg numbers.
 239  */
 240 static int cx_device_reload(struct cx_dev *cx_dev)
 241 {
 242         cx_device_unregister(cx_dev);
 243         return cx_device_register(cx_dev->cx_id.nasid, cx_dev->cx_id.part_num,
 244                                   cx_dev->cx_id.mfg_num, cx_dev->hubdev,
 245                                   cx_dev->bt);
 246 }
 247
 248 static inline u64 tiocx_intr_alloc(nasid_t nasid, int widget,
 249                                         u64 sn_irq_info,
 250                                         int req_irq, nasid_t req_nasid,
 251                                         int req_slice)
 252 {
 253         struct ia64_sal_retval rv;
 254         rv.status = 0;
 255         rv.v0 = 0;
 256
 257         ia64_sal_oemcall_nolock(&rv, SN_SAL_IOIF_INTERRUPT,
 258                                 SAL_INTR_ALLOC, nasid,
 259                                 widget, sn_irq_info, req_irq,
 260                                 req_nasid, req_slice);
 261         return rv.status;
 262 }
 263
 264 static inline void tiocx_intr_free(nasid_t nasid, int widget,
 265                                    struct sn_irq_info *sn_irq_info)
 266 {
 267         struct ia64_sal_retval rv;
 268         rv.status = 0;
 269         rv.v0 = 0;
 270
 271         ia64_sal_oemcall_nolock(&rv, SN_SAL_IOIF_INTERRUPT,
 272                                 SAL_INTR_FREE, nasid,
 273                                 widget, sn_irq_info->irq_irq,
 274                                 sn_irq_info->irq_cookie, 0, 0);
 275 }
 276
 277 struct sn_irq_info *tiocx_irq_alloc(nasid_t nasid, int widget, int irq,
 278                                     nasid_t req_nasid, int slice)
 279 {
 280         struct sn_irq_info *sn_irq_info;
 281         int status;
 282         int sn_irq_size = sizeof(struct sn_irq_info);
 283
 284         if ((nasid & 1) == 0)
 285                 return NULL;
 286
 287         sn_irq_info = kzalloc(sn_irq_size, GFP_KERNEL);
 288         if (sn_irq_info == NULL)
 289                 return NULL;
 290
 291         status = tiocx_intr_alloc(nasid, widget, __pa(sn_irq_info), irq,
 292                                   req_nasid, slice);
 293         if (status) {
 294                 kfree(sn_irq_info);
 295                 return NULL;
 296         } else {
 297                 return sn_irq_info;
 298         }
 299 }
 300
 301 void tiocx_irq_free(struct sn_irq_info *sn_irq_info)
 302 {
 303         u64 bridge = (u64) sn_irq_info->irq_bridge;
 304         nasid_t nasid = NASID_GET(bridge);
 305         int widget;
 306
 307         if (nasid & 1) {
 308                 widget = TIO_SWIN_WIDGETNUM(bridge);
 309                 tiocx_intr_free(nasid, widget, sn_irq_info);
 310                 kfree(sn_irq_info);
 311         }
 312 }
 313
 314 u64 tiocx_dma_addr(u64 addr)
 315 {
 316         return PHYS_TO_TIODMA(addr);
 317 }
 318
 319 u64 tiocx_swin_base(int nasid)
 320 {
 321         return TIO_SWIN_BASE(nasid, TIOCX_CORELET);
 322 }
 323
 324 EXPORT_SYMBOL(cx_driver_register);
 325 EXPORT_SYMBOL(cx_driver_unregister);
 326 EXPORT_SYMBOL(cx_device_register);
 327 EXPORT_SYMBOL(cx_device_unregister);
 328 EXPORT_SYMBOL(tiocx_irq_alloc);
 329 EXPORT_SYMBOL(tiocx_irq_free);
 330 EXPORT_SYMBOL(tiocx_bus_type);
 331 EXPORT_SYMBOL(tiocx_dma_addr);
 332 EXPORT_SYMBOL(tiocx_swin_base);
 333
 334 static void tio_conveyor_set(nasid_t nasid, int enable_flag)
 335 {
 336         u64 ice_frz;
 337         u64 disable_cb = (1ull << 61);
 338
 339         if (!(nasid & 1))
 340                 return;
 341
 342         ice_frz = REMOTE_HUB_L(nasid, TIO_ICE_FRZ_CFG);
 343         if (enable_flag) {
 344                 if (!(ice_frz & disable_cb))    /* already enabled */
 345                         return;
 346                 ice_frz &= ~disable_cb;
 347         } else {
 348                 if (ice_frz & disable_cb)       /* already disabled */
 349                         return;
 350                 ice_frz |= disable_cb;
 351         }
 352         DBG(KERN_ALERT "TIO_ICE_FRZ_CFG= 0x%lx\n", ice_frz);
 353         REMOTE_HUB_S(nasid, TIO_ICE_FRZ_CFG, ice_frz);
 354 }
 355
 356 #define tio_conveyor_enable(nasid) tio_conveyor_set(nasid, 1)
 357 #define tio_conveyor_disable(nasid) tio_conveyor_set(nasid, 0)
 358
 359 static void tio_corelet_reset(nasid_t nasid, int corelet)
 360 {
 361         if (!(nasid & 1))
 362                 return;
 363
 364         REMOTE_HUB_S(nasid, TIO_ICE_PMI_TX_CFG, 1 << corelet);
 365         udelay(2000);
 366         REMOTE_HUB_S(nasid, TIO_ICE_PMI_TX_CFG, 0);
 367         udelay(2000);
 368 }
 369
 370 static int is_fpga_tio(int nasid, int *bt)
 371 {
 372         int ioboard_type;
 373
 374         ioboard_type = ia64_sn_sysctl_ioboard_get(nasid);
 375
 376         switch (ioboard_type) {
 377         case L1_BRICKTYPE_SA:
 378         case L1_BRICKTYPE_ATHENA:
 379         case L1_BOARDTYPE_DAYTONA:
 380                 *bt = ioboard_type;
 381                 return 1;
 382         }
 383
 384         return 0;
 385 }
 386
 387 static int bitstream_loaded(nasid_t nasid)
 388 {
 389         u64 cx_credits;
 390
 391         cx_credits = REMOTE_HUB_L(nasid, TIO_ICE_PMI_TX_DYN_CREDIT_STAT_CB3);
 392         cx_credits &= TIO_ICE_PMI_TX_DYN_CREDIT_STAT_CB3_CREDIT_CNT_MASK;
 393         DBG("cx_credits= 0x%lx\n", cx_credits);
 394
 395         return (cx_credits == 0xf) ? 1 : 0;
 396 }
 397
 398 static int tiocx_reload(struct cx_dev *cx_dev)
 399 {
 400         int part_num = CX_DEV_NONE;
 401         int mfg_num = CX_DEV_NONE;
 402         nasid_t nasid = cx_dev->cx_id.nasid;
 403
 404         if (bitstream_loaded(nasid)) {
 405                 u64 cx_id;
 406                 int rv;
 407
 408                 rv = ia64_sn_sysctl_tio_clock_reset(nasid);
 409                 if (rv) {
 410                         printk(KERN_ALERT "CX port JTAG reset failed.\n");
 411                 } else {
 412                         cx_id = *(volatile u64 *)
 413                                 (TIO_SWIN_BASE(nasid, TIOCX_CORELET) +
 414                                           WIDGET_ID);
 415                         part_num = XWIDGET_PART_NUM(cx_id);
 416                         mfg_num = XWIDGET_MFG_NUM(cx_id);
 417                         DBG("part= 0x%x, mfg= 0x%x\n", part_num, mfg_num);
 418                         /* just ignore it if it's a CE */
 419                         if (part_num == TIO_CE_ASIC_PARTNUM)
 420                                 return 0;
 421                 }
 422         }
 423
 424         cx_dev->cx_id.part_num = part_num;
 425         cx_dev->cx_id.mfg_num = mfg_num;
 426
 427         /*
 428          * Delete old device and register the new one.  It's ok if
 429          * part_num/mfg_num == CX_DEV_NONE.  We want to register
 430          * devices in the table even if a bitstream isn't loaded.
 431          * That allows use to see that a bitstream isn't loaded via
 432          * TIOCX_IOCTL_DEV_LIST.
 433          */
 434         return cx_device_reload(cx_dev);
 435 }
 436
 437 static ssize_t show_cxdev_control(struct device *dev, struct device_attribute *attr, char *buf)
 438 {
 439         struct cx_dev *cx_dev = to_cx_dev(dev);
 440
 441         return sprintf(buf, "0x%x 0x%x 0x%x 0x%x\n",
 442                        cx_dev->cx_id.nasid,
 443                        cx_dev->cx_id.part_num, cx_dev->cx_id.mfg_num,
 444                        cx_dev->bt);
 445 }
 446
 447 static ssize_t store_cxdev_control(struct device *dev, struct device_attribute *attr, const char *buf,
 448                                    size_t count)
 449 {
 450         int n;
 451         struct cx_dev *cx_dev = to_cx_dev(dev);
 452
 453         if (!capable(CAP_SYS_ADMIN))
 454                 return -EPERM;
 455
 456         if (count <= 0)
 457                 return 0;
 458
 459         n = simple_strtoul(buf, NULL, 0);
 460
 461         switch (n) {
 462         case 1:
 463                 tio_corelet_reset(cx_dev->cx_id.nasid, TIOCX_CORELET);
 464                 tiocx_reload(cx_dev);
 465                 break;
 466         case 2:
 467                 tiocx_reload(cx_dev);
 468                 break;
 469         case 3:
 470                 tio_corelet_reset(cx_dev->cx_id.nasid, TIOCX_CORELET);
 471                 break;
 472         default:
 473                 break;
 474         }
 475
 476         return count;
 477 }
 478
 479 DEVICE_ATTR(cxdev_control, 0644, show_cxdev_control, store_cxdev_control);
 480
 481 static int __init tiocx_init(void)
 482 {
 483         cnodeid_t cnodeid;
 484         int found_tiocx_device = 0;
 485
 486         if (!ia64_platform_is("sn2"))
 487                 return -ENODEV;
 488
 489         bus_register(&tiocx_bus_type);
 490
 491         for (cnodeid = 0; cnodeid < num_cnodes; cnodeid++) {
 492                 nasid_t nasid;
 493                 int bt;
 494
 495                 nasid = cnodeid_to_nasid(cnodeid);
 496
 497                 if ((nasid & 0x1) && is_fpga_tio(nasid, &bt)) {
 498                         struct hubdev_info *hubdev;
 499                         struct xwidget_info *widgetp;
 500
 501                         DBG("Found TIO at nasid 0x%x\n", nasid);
 502
 503                         hubdev =
 504                             (struct hubdev_info *)(NODEPDA(cnodeid)->pdinfo);
 505
 506                         widgetp = &hubdev->hdi_xwidget_info[TIOCX_CORELET];
 507
 508                         /* The CE hangs off of the CX port but is not an FPGA */
 509                         if (widgetp->xwi_hwid.part_num == TIO_CE_ASIC_PARTNUM)
 510                                 continue;
 511
 512                         tio_corelet_reset(nasid, TIOCX_CORELET);
 513                         tio_conveyor_enable(nasid);
 514
 515                         if (cx_device_register
 516                             (nasid, widgetp->xwi_hwid.part_num,
 517                              widgetp->xwi_hwid.mfg_num, hubdev, bt) < 0)
 518                                 return -ENXIO;
 519                         else
 520                                 found_tiocx_device++;
 521                 }
 522         }
 523
 524         /* It's ok if we find zero devices. */
 525         DBG("found_tiocx_device= %d\n", found_tiocx_device);
 526
 527         return 0;
 528 }
 529
 530 static int cx_remove_device(struct device * dev, void * data)
 531 {
 532         struct cx_dev *cx_dev = to_cx_dev(dev);
 533         device_remove_file(dev, &dev_attr_cxdev_control);
 534         cx_device_unregister(cx_dev);
 535         return 0;
 536 }
 537
 538 static void __exit tiocx_exit(void)
 539 {
 540         DBG("tiocx_exit\n");
 541
 542         /*
 543          * Unregister devices.
 544          */
 545         bus_for_each_dev(&tiocx_bus_type, NULL, NULL, cx_remove_device);
 546         bus_unregister(&tiocx_bus_type);
 547 }
 548
 549 subsys_initcall(tiocx_init);
 550 module_exit(tiocx_exit);
 551
 552 /************************************************************************
 553  * Module licensing and description
 554  ************************************************************************/
 555 MODULE_LICENSE("GPL");
 556 MODULE_AUTHOR("Bruce Losure <blosure@sgi.com>");
 557 MODULE_DESCRIPTION("TIOCX module");
 558 MODULE_SUPPORTED_DEVICE(DEVICE_NAME);