drivers/s390/cio/blacklist.c

   1 /*
   2  *  drivers/s390/cio/blacklist.c
   3  *   S/390 common I/O routines -- blacklisting of specific devices
   4  *
   5  *    Copyright (C) 1999-2002 IBM Deutschland Entwicklung GmbH,
   6  *                            IBM Corporation
   7  *    Author(s): Ingo Adlung (adlung@de.ibm.com)
   8  *               Cornelia Huck (cornelia.huck@de.ibm.com)
   9  *               Arnd Bergmann (arndb@de.ibm.com)
  10  */
  11
  12 #include <linux/init.h>
  13 #include <linux/vmalloc.h>
  14 #include <linux/slab.h>
  15 #include <linux/proc_fs.h>
  16 #include <linux/seq_file.h>
  17 #include <linux/ctype.h>
  18 #include <linux/device.h>
  19
  20 #include <asm/cio.h>
  21 #include <asm/uaccess.h>
  22
  23 #include "blacklist.h"
  24 #include "cio.h"
  25 #include "cio_debug.h"
  26 #include "css.h"
  27
  28 /*
  29  * "Blacklisting" of certain devices:
  30  * Device numbers given in the commandline as cio_ignore=... won't be known
  31  * to Linux.
  32  *
  33  * These can be single devices or ranges of devices
  34  */
  35
  36 /* 65536 bits for each set to indicate if a devno is blacklisted or not */
  37 #define __BL_DEV_WORDS ((__MAX_SUBCHANNEL + (8*sizeof(long) - 1)) / \
  38                          (8*sizeof(long)))
  39 static unsigned long bl_dev[__MAX_SSID + 1][__BL_DEV_WORDS];
  40 typedef enum {add, free} range_action;
  41
  42 /*
  43  * Function: blacklist_range
  44  * (Un-)blacklist the devices from-to
  45  */
  46 static void
  47 blacklist_range (range_action action, unsigned int from, unsigned int to,
  48                  unsigned int ssid)
  49 {
  50         if (!to)
  51                 to = from;
  52
  53         if (from > to || to > __MAX_SUBCHANNEL || ssid > __MAX_SSID) {
  54                 printk (KERN_WARNING "cio: Invalid blacklist range "
  55                         "0.%x.%04x to 0.%x.%04x, skipping\n",
  56                         ssid, from, ssid, to);
  57                 return;
  58         }
  59         for (; from <= to; from++) {
  60                 if (action == add)
  61                         set_bit (from, bl_dev[ssid]);
  62                 else
  63                         clear_bit (from, bl_dev[ssid]);
  64         }
  65 }
  66
  67 /*
  68  * Function: blacklist_busid
  69  * Get devno/busid from given string.
  70  * Shamelessly grabbed from dasd_devmap.c.
  71  */
  72 static int
  73 blacklist_busid(char **str, int *id0, int *ssid, int *devno)
  74 {
  75         int val, old_style;
  76         char *sav;
  77
  78         sav = *str;
  79
  80         /* check for leading '0x' */
  81         old_style = 0;
  82         if ((*str)[0] == '0' && (*str)[1] == 'x') {
  83                 *str += 2;
  84                 old_style = 1;
  85         }
  86         if (!isxdigit((*str)[0]))       /* We require at least one hex digit */
  87                 goto confused;
  88         val = simple_strtoul(*str, str, 16);
  89         if (old_style || (*str)[0] != '.') {
  90                 *id0 = *ssid = 0;
  91                 if (val < 0 || val > 0xffff)
  92                         goto confused;
  93                 *devno = val;
  94                 if ((*str)[0] != ',' && (*str)[0] != '-' &&
  95                     (*str)[0] != '\n' && (*str)[0] != '\0')
  96                         goto confused;
  97                 return 0;
  98         }
  99         /* New style x.y.z busid */
 100         if (val < 0 || val > 0xff)
 101                 goto confused;
 102         *id0 = val;
 103         (*str)++;
 104         if (!isxdigit((*str)[0]))       /* We require at least one hex digit */
 105                 goto confused;
 106         val = simple_strtoul(*str, str, 16);
 107         if (val < 0 || val > 0xff || (*str)++[0] != '.')
 108                 goto confused;
 109         *ssid = val;
 110         if (!isxdigit((*str)[0]))       /* We require at least one hex digit */
 111                 goto confused;
 112         val = simple_strtoul(*str, str, 16);
 113         if (val < 0 || val > 0xffff)
 114                 goto confused;
 115         *devno = val;
 116         if ((*str)[0] != ',' && (*str)[0] != '-' &&
 117             (*str)[0] != '\n' && (*str)[0] != '\0')
 118                 goto confused;
 119         return 0;
 120 confused:
 121         strsep(str, ",\n");
 122         printk(KERN_WARNING "cio: Invalid cio_ignore parameter '%s'\n", sav);
 123         return 1;
 124 }
 125
 126 static int
 127 blacklist_parse_parameters (char *str, range_action action)
 128 {
 129         int from, to, from_id0, to_id0, from_ssid, to_ssid;
 130
 131         while (*str != 0 && *str != '\n') {
 132                 range_action ra = action;
 133                 while(*str == ',')
 134                         str++;
 135                 if (*str == '!') {
 136                         ra = !action;
 137                         ++str;
 138                 }
 139
 140                 /*
 141                  * Since we have to parse the proc commands and the
 142                  * kernel arguments we have to check four cases
 143                  */
 144                 if (strncmp(str,"all,",4) == 0 || strcmp(str,"all") == 0 ||
 145                     strncmp(str,"all\n",4) == 0 || strncmp(str,"all ",4) == 0) {
 146                         int j;
 147
 148                         str += 3;
 149                         for (j=0; j <= __MAX_SSID; j++)
 150                                 blacklist_range(ra, 0, __MAX_SUBCHANNEL, j);
 151                 } else {
 152                         int rc;
 153
 154                         rc = blacklist_busid(&str, &from_id0,
 155                                              &from_ssid, &from);
 156                         if (rc)
 157                                 continue;
 158                         to = from;
 159                         to_id0 = from_id0;
 160                         to_ssid = from_ssid;
 161                         if (*str == '-') {
 162                                 str++;
 163                                 rc = blacklist_busid(&str, &to_id0,
 164                                                      &to_ssid, &to);
 165                                 if (rc)
 166                                         continue;
 167                         }
 168                         if (*str == '-') {
 169                                 printk(KERN_WARNING "cio: invalid cio_ignore "
 170                                         "parameter '%s'\n",
 171                                         strsep(&str, ",\n"));
 172                                 continue;
 173                         }
 174                         if ((from_id0 != to_id0) ||
 175                             (from_ssid != to_ssid)) {
 176                                 printk(KERN_WARNING "cio: invalid cio_ignore "
 177                                        "range %x.%x.%04x-%x.%x.%04x\n",
 178                                        from_id0, from_ssid, from,
 179                                        to_id0, to_ssid, to);
 180                                 continue;
 181                         }
 182                         blacklist_range (ra, from, to, to_ssid);
 183                 }
 184         }
 185         return 1;
 186 }
 187
 188 /* Parsing the commandline for blacklist parameters, e.g. to blacklist
 189  * bus ids 0.0.1234, 0.0.1235 and 0.0.1236, you could use any of:
 190  * - cio_ignore=1234-1236
 191  * - cio_ignore=0x1234-0x1235,1236
 192  * - cio_ignore=0x1234,1235-1236
 193  * - cio_ignore=1236 cio_ignore=1234-0x1236
 194  * - cio_ignore=1234 cio_ignore=1236 cio_ignore=0x1235
 195  * - cio_ignore=0.0.1234-0.0.1236
 196  * - cio_ignore=0.0.1234,0x1235,1236
 197  * - ...
 198  */
 199 static int __init
 200 blacklist_setup (char *str)
 201 {
 202         CIO_MSG_EVENT(6, "Reading blacklist parameters\n");
 203         return blacklist_parse_parameters (str, add);
 204 }
 205
 206 __setup ("cio_ignore=", blacklist_setup);
 207
 208 /* Checking if devices are blacklisted */
 209
 210 /*
 211  * Function: is_blacklisted
 212  * Returns 1 if the given devicenumber can be found in the blacklist,
 213  * otherwise 0.
 214  * Used by validate_subchannel()
 215  */
 216 int
 217 is_blacklisted (int ssid, int devno)
 218 {
 219         return test_bit (devno, bl_dev[ssid]);
 220 }
 221
 222 #ifdef CONFIG_PROC_FS
 223 /*
 224  * Function: blacklist_parse_proc_parameters
 225  * parse the stuff which is piped to /proc/cio_ignore
 226  */
 227 static void
 228 blacklist_parse_proc_parameters (char *buf)
 229 {
 230         if (strncmp (buf, "free ", 5) == 0) {
 231                 blacklist_parse_parameters (buf + 5, free);
 232         } else if (strncmp (buf, "add ", 4) == 0) {
 233                 /*
 234                  * We don't need to check for known devices since
 235                  * css_probe_device will handle this correctly.
 236                  */
 237                 blacklist_parse_parameters (buf + 4, add);
 238         } else {
 239                 printk (KERN_WARNING "cio: cio_ignore: Parse error; \n"
 240                         KERN_WARNING "try using 'free all|<devno-range>,"
 241                                      "<devno-range>,...'\n"
 242                         KERN_WARNING "or 'add <devno-range>,"
 243                                      "<devno-range>,...'\n");
 244                 return;
 245         }
 246
 247         css_schedule_reprobe();
 248 }
 249
 250 /* Iterator struct for all devices. */
 251 struct ccwdev_iter {
 252         int devno;
 253         int ssid;
 254         int in_range;
 255 };
 256
 257 static void *
 258 cio_ignore_proc_seq_start(struct seq_file *s, loff_t *offset)
 259 {
 260         struct ccwdev_iter *iter;
 261
 262         if (*offset >= (__MAX_SUBCHANNEL + 1) * (__MAX_SSID + 1))
 263                 return NULL;
 264         iter = kzalloc(sizeof(struct ccwdev_iter), GFP_KERNEL);
 265         if (!iter)
 266                 return ERR_PTR(-ENOMEM);
 267         iter->ssid = *offset / (__MAX_SUBCHANNEL + 1);
 268         iter->devno = *offset % (__MAX_SUBCHANNEL + 1);
 269         return iter;
 270 }
 271
 272 static void
 273 cio_ignore_proc_seq_stop(struct seq_file *s, void *it)
 274 {
 275         if (!IS_ERR(it))
 276                 kfree(it);
 277 }
 278
 279 static void *
 280 cio_ignore_proc_seq_next(struct seq_file *s, void *it, loff_t *offset)
 281 {
 282         struct ccwdev_iter *iter;
 283
 284         if (*offset >= (__MAX_SUBCHANNEL + 1) * (__MAX_SSID + 1))
 285                 return NULL;
 286         iter = it;
 287         if (iter->devno == __MAX_SUBCHANNEL) {
 288                 iter->devno = 0;
 289                 iter->ssid++;
 290                 if (iter->ssid > __MAX_SSID)
 291                         return NULL;
 292         } else
 293                 iter->devno++;
 294         (*offset)++;
 295         return iter;
 296 }
 297
 298 static int
 299 cio_ignore_proc_seq_show(struct seq_file *s, void *it)
 300 {
 301         struct ccwdev_iter *iter;
 302
 303         iter = it;
 304         if (!is_blacklisted(iter->ssid, iter->devno))
 305                 /* Not blacklisted, nothing to output. */
 306                 return 0;
 307         if (!iter->in_range) {
 308                 /* First device in range. */
 309                 if ((iter->devno == __MAX_SUBCHANNEL) ||
 310                     !is_blacklisted(iter->ssid, iter->devno + 1))
 311                         /* Singular device. */
 312                         return seq_printf(s, "0.%x.%04x\n",
 313                                           iter->ssid, iter->devno);
 314                 iter->in_range = 1;
 315                 return seq_printf(s, "0.%x.%04x-", iter->ssid, iter->devno);
 316         }
 317         if ((iter->devno == __MAX_SUBCHANNEL) ||
 318             !is_blacklisted(iter->ssid, iter->devno + 1)) {
 319                 /* Last device in range. */
 320                 iter->in_range = 0;
 321                 return seq_printf(s, "0.%x.%04x\n", iter->ssid, iter->devno);
 322         }
 323         return 0;
 324 }
 325
 326 static ssize_t
 327 cio_ignore_write(struct file *file, const char __user *user_buf,
 328                  size_t user_len, loff_t *offset)
 329 {
 330         char *buf;
 331
 332         if (*offset)
 333                 return -EINVAL;
 334         if (user_len > 65536)
 335                 user_len = 65536;
 336         buf = vmalloc (user_len + 1); /* maybe better use the stack? */
 337         if (buf == NULL)
 338                 return -ENOMEM;
 339         if (strncpy_from_user (buf, user_buf, user_len) < 0) {
 340                 vfree (buf);
 341                 return -EFAULT;
 342         }
 343         buf[user_len] = '\0';
 344
 345         blacklist_parse_proc_parameters (buf);
 346
 347         vfree (buf);
 348         return user_len;
 349 }
 350
 351 static const struct seq_operations cio_ignore_proc_seq_ops = {
 352         .start = cio_ignore_proc_seq_start,
 353         .stop  = cio_ignore_proc_seq_stop,
 354         .next  = cio_ignore_proc_seq_next,
 355         .show  = cio_ignore_proc_seq_show,
 356 };
 357
 358 static int
 359 cio_ignore_proc_open(struct inode *inode, struct file *file)
 360 {
 361         return seq_open(file, &cio_ignore_proc_seq_ops);
 362 }
 363
 364 static const struct file_operations cio_ignore_proc_fops = {
 365         .open    = cio_ignore_proc_open,
 366         .read    = seq_read,
 367         .llseek  = seq_lseek,
 368         .release = seq_release,
 369         .write   = cio_ignore_write,
 370 };
 371
 372 static int
 373 cio_ignore_proc_init (void)
 374 {
 375         struct proc_dir_entry *entry;
 376
 377         entry = create_proc_entry ("cio_ignore", S_IFREG | S_IRUGO | S_IWUSR,
 378                                    &proc_root);
 379         if (!entry)
 380                 return -ENOENT;
 381
 382         entry->proc_fops = &cio_ignore_proc_fops;
 383
 384         return 0;
 385 }
 386
 387 __initcall (cio_ignore_proc_init);
 388
 389 #endif /* CONFIG_PROC_FS */