drivers/s390/cio/eadm_sch.c

   1 /*
   2  * Driver for s390 eadm subchannels
   3  *
   4  * Copyright IBM Corp. 2012
   5  * Author(s): Sebastian Ott <sebott@linux.vnet.ibm.com>
   6  */
   7
   8 #include <linux/kernel_stat.h>
   9 #include <linux/completion.h>
  10 #include <linux/workqueue.h>
  11 #include <linux/spinlock.h>
  12 #include <linux/device.h>
  13 #include <linux/module.h>
  14 #include <linux/timer.h>
  15 #include <linux/slab.h>
  16 #include <linux/list.h>
  17
  18 #include <asm/css_chars.h>
  19 #include <asm/debug.h>
  20 #include <asm/isc.h>
  21 #include <asm/cio.h>
  22 #include <asm/scsw.h>
  23 #include <asm/eadm.h>
  24
  25 #include "eadm_sch.h"
  26 #include "ioasm.h"
  27 #include "cio.h"
  28 #include "css.h"
  29 #include "orb.h"
  30
  31 MODULE_DESCRIPTION("driver for s390 eadm subchannels");
  32 MODULE_LICENSE("GPL");
  33
  34 #define EADM_TIMEOUT (7 * HZ)
  35 static DEFINE_SPINLOCK(list_lock);
  36 static LIST_HEAD(eadm_list);
  37
  38 static debug_info_t *eadm_debug;
  39
  40 #define EADM_LOG(imp, txt) do {                                 \
  41                 debug_text_event(eadm_debug, imp, txt);         \
  42         } while (0)
  43
  44 static void EADM_LOG_HEX(int level, void *data, int length)
  45 {
  46         debug_event(eadm_debug, level, data, length);
  47 }
  48
  49 static void orb_init(union orb *orb)
  50 {
  51         memset(orb, 0, sizeof(union orb));
  52         orb->eadm.compat1 = 1;
  53         orb->eadm.compat2 = 1;
  54         orb->eadm.fmt = 1;
  55         orb->eadm.x = 1;
  56 }
  57
  58 static int eadm_subchannel_start(struct subchannel *sch, struct aob *aob)
  59 {
  60         union orb *orb = &get_eadm_private(sch)->orb;
  61         int cc;
  62
  63         orb_init(orb);
  64         orb->eadm.aob = (u32)__pa(aob);
  65         orb->eadm.intparm = (u32)(addr_t)sch;
  66         orb->eadm.key = PAGE_DEFAULT_KEY >> 4;
  67
  68         EADM_LOG(6, "start");
  69         EADM_LOG_HEX(6, &sch->schid, sizeof(sch->schid));
  70
  71         cc = ssch(sch->schid, orb);
  72         switch (cc) {
  73         case 0:
  74                 sch->schib.scsw.eadm.actl |= SCSW_ACTL_START_PEND;
  75                 break;
  76         case 1:         /* status pending */
  77         case 2:         /* busy */
  78                 return -EBUSY;
  79         case 3:         /* not operational */
  80                 return -ENODEV;
  81         }
  82         return 0;
  83 }
  84
  85 static int eadm_subchannel_clear(struct subchannel *sch)
  86 {
  87         int cc;
  88
  89         cc = csch(sch->schid);
  90         if (cc)
  91                 return -ENODEV;
  92
  93         sch->schib.scsw.eadm.actl |= SCSW_ACTL_CLEAR_PEND;
  94         return 0;
  95 }
  96
  97 static void eadm_subchannel_timeout(unsigned long data)
  98 {
  99         struct subchannel *sch = (struct subchannel *) data;
 100
 101         spin_lock_irq(sch->lock);
 102         EADM_LOG(1, "timeout");
 103         EADM_LOG_HEX(1, &sch->schid, sizeof(sch->schid));
 104         if (eadm_subchannel_clear(sch))
 105                 EADM_LOG(0, "clear failed");
 106         spin_unlock_irq(sch->lock);
 107 }
 108
 109 static void eadm_subchannel_set_timeout(struct subchannel *sch, int expires)
 110 {
 111         struct eadm_private *private = get_eadm_private(sch);
 112
 113         if (expires == 0) {
 114                 del_timer(&private->timer);
 115                 return;
 116         }
 117         if (timer_pending(&private->timer)) {
 118                 if (mod_timer(&private->timer, jiffies + expires))
 119                         return;
 120         }
 121         private->timer.function = eadm_subchannel_timeout;
 122         private->timer.data = (unsigned long) sch;
 123         private->timer.expires = jiffies + expires;
 124         add_timer(&private->timer);
 125 }
 126
 127 static void eadm_subchannel_irq(struct subchannel *sch)
 128 {
 129         struct eadm_private *private = get_eadm_private(sch);
 130         struct eadm_scsw *scsw = &sch->schib.scsw.eadm;
 131         struct irb *irb = this_cpu_ptr(&cio_irb);
 132         blk_status_t error = BLK_STS_OK;
 133
 134         EADM_LOG(6, "irq");
 135         EADM_LOG_HEX(6, irb, sizeof(*irb));
 136
 137         inc_irq_stat(IRQIO_ADM);
 138
 139         if ((scsw->stctl & (SCSW_STCTL_ALERT_STATUS | SCSW_STCTL_STATUS_PEND))
 140             && scsw->eswf == 1 && irb->esw.eadm.erw.r)
 141                 error = BLK_STS_IOERR;
 142
 143         if (scsw->fctl & SCSW_FCTL_CLEAR_FUNC)
 144                 error = BLK_STS_TIMEOUT;
 145
 146         eadm_subchannel_set_timeout(sch, 0);
 147
 148         if (private->state != EADM_BUSY) {
 149                 EADM_LOG(1, "irq unsol");
 150                 EADM_LOG_HEX(1, irb, sizeof(*irb));
 151                 private->state = EADM_NOT_OPER;
 152                 css_sched_sch_todo(sch, SCH_TODO_EVAL);
 153                 return;
 154         }
 155         scm_irq_handler((struct aob *)(unsigned long)scsw->aob, error);
 156         private->state = EADM_IDLE;
 157
 158         if (private->completion)
 159                 complete(private->completion);
 160 }
 161
 162 static struct subchannel *eadm_get_idle_sch(void)
 163 {
 164         struct eadm_private *private;
 165         struct subchannel *sch;
 166         unsigned long flags;
 167
 168         spin_lock_irqsave(&list_lock, flags);
 169         list_for_each_entry(private, &eadm_list, head) {
 170                 sch = private->sch;
 171                 spin_lock(sch->lock);
 172                 if (private->state == EADM_IDLE) {
 173                         private->state = EADM_BUSY;
 174                         list_move_tail(&private->head, &eadm_list);
 175                         spin_unlock(sch->lock);
 176                         spin_unlock_irqrestore(&list_lock, flags);
 177
 178                         return sch;
 179                 }
 180                 spin_unlock(sch->lock);
 181         }
 182         spin_unlock_irqrestore(&list_lock, flags);
 183
 184         return NULL;
 185 }
 186
 187 int eadm_start_aob(struct aob *aob)
 188 {
 189         struct eadm_private *private;
 190         struct subchannel *sch;
 191         unsigned long flags;
 192         int ret;
 193
 194         sch = eadm_get_idle_sch();
 195         if (!sch)
 196                 return -EBUSY;
 197
 198         spin_lock_irqsave(sch->lock, flags);
 199         eadm_subchannel_set_timeout(sch, EADM_TIMEOUT);
 200         ret = eadm_subchannel_start(sch, aob);
 201         if (!ret)
 202                 goto out_unlock;
 203
 204         /* Handle start subchannel failure. */
 205         eadm_subchannel_set_timeout(sch, 0);
 206         private = get_eadm_private(sch);
 207         private->state = EADM_NOT_OPER;
 208         css_sched_sch_todo(sch, SCH_TODO_EVAL);
 209
 210 out_unlock:
 211         spin_unlock_irqrestore(sch->lock, flags);
 212
 213         return ret;
 214 }
 215 EXPORT_SYMBOL_GPL(eadm_start_aob);
 216
 217 static int eadm_subchannel_probe(struct subchannel *sch)
 218 {
 219         struct eadm_private *private;
 220         int ret;
 221
 222         private = kzalloc(sizeof(*private), GFP_KERNEL | GFP_DMA);
 223         if (!private)
 224                 return -ENOMEM;
 225
 226         INIT_LIST_HEAD(&private->head);
 227         init_timer(&private->timer);
 228
 229         spin_lock_irq(sch->lock);
 230         set_eadm_private(sch, private);
 231         private->state = EADM_IDLE;
 232         private->sch = sch;
 233         sch->isc = EADM_SCH_ISC;
 234         ret = cio_enable_subchannel(sch, (u32)(unsigned long)sch);
 235         if (ret) {
 236                 set_eadm_private(sch, NULL);
 237                 spin_unlock_irq(sch->lock);
 238                 kfree(private);
 239                 goto out;
 240         }
 241         spin_unlock_irq(sch->lock);
 242
 243         spin_lock_irq(&list_lock);
 244         list_add(&private->head, &eadm_list);
 245         spin_unlock_irq(&list_lock);
 246
 247         if (dev_get_uevent_suppress(&sch->dev)) {
 248                 dev_set_uevent_suppress(&sch->dev, 0);
 249                 kobject_uevent(&sch->dev.kobj, KOBJ_ADD);
 250         }
 251 out:
 252         return ret;
 253 }
 254
 255 static void eadm_quiesce(struct subchannel *sch)
 256 {
 257         struct eadm_private *private = get_eadm_private(sch);
 258         DECLARE_COMPLETION_ONSTACK(completion);
 259         int ret;
 260
 261         spin_lock_irq(sch->lock);
 262         if (private->state != EADM_BUSY)
 263                 goto disable;
 264
 265         if (eadm_subchannel_clear(sch))
 266                 goto disable;
 267
 268         private->completion = &completion;
 269         spin_unlock_irq(sch->lock);
 270
 271         wait_for_completion_io(&completion);
 272
 273         spin_lock_irq(sch->lock);
 274         private->completion = NULL;
 275
 276 disable:
 277         eadm_subchannel_set_timeout(sch, 0);
 278         do {
 279                 ret = cio_disable_subchannel(sch);
 280         } while (ret == -EBUSY);
 281
 282         spin_unlock_irq(sch->lock);
 283 }
 284
 285 static int eadm_subchannel_remove(struct subchannel *sch)
 286 {
 287         struct eadm_private *private = get_eadm_private(sch);
 288
 289         spin_lock_irq(&list_lock);
 290         list_del(&private->head);
 291         spin_unlock_irq(&list_lock);
 292
 293         eadm_quiesce(sch);
 294
 295         spin_lock_irq(sch->lock);
 296         set_eadm_private(sch, NULL);
 297         spin_unlock_irq(sch->lock);
 298
 299         kfree(private);
 300
 301         return 0;
 302 }
 303
 304 static void eadm_subchannel_shutdown(struct subchannel *sch)
 305 {
 306         eadm_quiesce(sch);
 307 }
 308
 309 static int eadm_subchannel_freeze(struct subchannel *sch)
 310 {
 311         return cio_disable_subchannel(sch);
 312 }
 313
 314 static int eadm_subchannel_restore(struct subchannel *sch)
 315 {
 316         return cio_enable_subchannel(sch, (u32)(unsigned long)sch);
 317 }
 318
 319 /**
 320  * eadm_subchannel_sch_event - process subchannel event
 321  * @sch: subchannel
 322  * @process: non-zero if function is called in process context
 323  *
 324  * An unspecified event occurred for this subchannel. Adjust data according
 325  * to the current operational state of the subchannel. Return zero when the
 326  * event has been handled sufficiently or -EAGAIN when this function should
 327  * be called again in process context.
 328  */
 329 static int eadm_subchannel_sch_event(struct subchannel *sch, int process)
 330 {
 331         struct eadm_private *private;
 332         unsigned long flags;
 333
 334         spin_lock_irqsave(sch->lock, flags);
 335         if (!device_is_registered(&sch->dev))
 336                 goto out_unlock;
 337
 338         if (work_pending(&sch->todo_work))
 339                 goto out_unlock;
 340
 341         if (cio_update_schib(sch)) {
 342                 css_sched_sch_todo(sch, SCH_TODO_UNREG);
 343                 goto out_unlock;
 344         }
 345         private = get_eadm_private(sch);
 346         if (private->state == EADM_NOT_OPER)
 347                 private->state = EADM_IDLE;
 348
 349 out_unlock:
 350         spin_unlock_irqrestore(sch->lock, flags);
 351
 352         return 0;
 353 }
 354
 355 static struct css_device_id eadm_subchannel_ids[] = {
 356         { .match_flags = 0x1, .type = SUBCHANNEL_TYPE_ADM, },
 357         { /* end of list */ },
 358 };
 359 MODULE_DEVICE_TABLE(css, eadm_subchannel_ids);
 360
 361 static struct css_driver eadm_subchannel_driver = {
 362         .drv = {
 363                 .name = "eadm_subchannel",
 364                 .owner = THIS_MODULE,
 365         },
 366         .subchannel_type = eadm_subchannel_ids,
 367         .irq = eadm_subchannel_irq,
 368         .probe = eadm_subchannel_probe,
 369         .remove = eadm_subchannel_remove,
 370         .shutdown = eadm_subchannel_shutdown,
 371         .sch_event = eadm_subchannel_sch_event,
 372         .freeze = eadm_subchannel_freeze,
 373         .thaw = eadm_subchannel_restore,
 374         .restore = eadm_subchannel_restore,
 375 };
 376
 377 static int __init eadm_sch_init(void)
 378 {
 379         int ret;
 380
 381         if (!css_general_characteristics.eadm)
 382                 return -ENXIO;
 383
 384         eadm_debug = debug_register("eadm_log", 16, 1, 16);
 385         if (!eadm_debug)
 386                 return -ENOMEM;
 387
 388         debug_register_view(eadm_debug, &debug_hex_ascii_view);
 389         debug_set_level(eadm_debug, 2);
 390
 391         isc_register(EADM_SCH_ISC);
 392         ret = css_driver_register(&eadm_subchannel_driver);
 393         if (ret)
 394                 goto cleanup;
 395
 396         return ret;
 397
 398 cleanup:
 399         isc_unregister(EADM_SCH_ISC);
 400         debug_unregister(eadm_debug);
 401         return ret;
 402 }
 403
 404 static void __exit eadm_sch_exit(void)
 405 {
 406         css_driver_unregister(&eadm_subchannel_driver);
 407         isc_unregister(EADM_SCH_ISC);
 408         debug_unregister(eadm_debug);
 409 }
 410 module_init(eadm_sch_init);
 411 module_exit(eadm_sch_exit);