linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Author(s)......: Holger Smolinski <Holger.Smolinski@de.ibm.com>

 *          Horst Hummel <Horst.Hummel@de.ibm.com>

 *          Carsten Otte <Cotte@de.ibm.com>

 *          Martin Schwidefsky <schwidefsky@de.ibm.com>

 * Bugreports.to..: <Linux390@de.ibm.com>

 * Copyright IBM Corp. 1999, 2001

 *

 */

​

#define KMSG_COMPONENT "dasd"

​

#include <linux/ctype.h>

#include <linux/init.h>

​

#include <asm/debug.h>

#include <asm/ebcdic.h>

#include <linux/uaccess.h>

​

/* This is ugly... */

#define PRINTK_HEADER "dasd_erp:"

​

#include "dasd_int.h"

​

struct dasd_ccw_req *

dasd_alloc_erp_request(char *magic, int cplength, int datasize,

               struct dasd_device * device)

{

    unsigned long flags;

    struct dasd_ccw_req *cqr;

    char *data;

    int size;

​

    /* Sanity checks */

    BUG_ON( magic == NULL || datasize > PAGE_SIZE ||

         (cplength*sizeof(struct ccw1)) > PAGE_SIZE);

​

    size = (sizeof(struct dasd_ccw_req) + 7L) & -8L;

    if (cplength > 0)

        size += cplength * sizeof(struct ccw1);

    if (datasize > 0)

        size += datasize;

    spin_lock_irqsave(&device->mem_lock, flags);

    cqr = (struct dasd_ccw_req *)

        dasd_alloc_chunk(&device->erp_chunks, size);

    spin_unlock_irqrestore(&device->mem_lock, flags);

    if (cqr == NULL)

        return ERR_PTR(-ENOMEM);

    memset(cqr, 0, sizeof(struct dasd_ccw_req));

    INIT_LIST_HEAD(&cqr->devlist);

    INIT_LIST_HEAD(&cqr->blocklist);

    data = (char *) cqr + ((sizeof(struct dasd_ccw_req) + 7L) & -8L);

    cqr->cpaddr = NULL;

    if (cplength > 0) {

        cqr->cpaddr = (struct ccw1 *) data;

        data += cplength*sizeof(struct ccw1);

        memset(cqr->cpaddr, 0, cplength*sizeof(struct ccw1));

    }

    cqr->data = NULL;

    if (datasize > 0) {

        cqr->data = data;

        memset(cqr->data, 0, datasize);

    }

    strncpy((char *) &cqr->magic, magic, 4);

    ASCEBC((char *) &cqr->magic, 4);

    set_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags);

    dasd_get_device(device);

    return cqr;

}

​

void

dasd_free_erp_request(struct dasd_ccw_req *cqr, struct dasd_device * device)

{

    unsigned long flags;

​

    spin_lock_irqsave(&device->mem_lock, flags);

    dasd_free_chunk(&device->erp_chunks, cqr);

    spin_unlock_irqrestore(&device->mem_lock, flags);

    atomic_dec(&device->ref_count);

}

​

​

/*

 * dasd_default_erp_action just retries the current cqr

 */

struct dasd_ccw_req *

dasd_default_erp_action(struct dasd_ccw_req *cqr)

{

    struct dasd_device *device;

​

    device = cqr->startdev;