linux-imx

// SPDX-License-Identifier: GPL-2.0-only

/*

 * SCSI Enclosure Services

 *

 * Copyright (C) 2008 James Bottomley <James.Bottomley@HansenPartnership.com>

 *

**-----------------------------------------------------------------------------

**

**

**-----------------------------------------------------------------------------

*/

​

#include <linux/slab.h>

#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/enclosure.h>

#include <asm/unaligned.h>

​

#include <scsi/scsi.h>

#include <scsi/scsi_cmnd.h>

#include <scsi/scsi_dbg.h>

#include <scsi/scsi_device.h>

#include <scsi/scsi_driver.h>

#include <scsi/scsi_host.h>

​

#include <scsi/scsi_transport_sas.h>

​

struct ses_device {

    unsigned char *page1;

    unsigned char *page1_types;

    unsigned char *page2;

    unsigned char *page10;

    short page1_len;

    short page1_num_types;

    short page2_len;

    short page10_len;

};

​

struct ses_component {

    u64 addr;

};

​

static bool ses_page2_supported(struct enclosure_device *edev)

{

    struct ses_device *ses_dev = edev->scratch;

​

    return (ses_dev->page2 != NULL);

}

​

static int ses_probe(struct device *dev)

{

    struct scsi_device *sdev = to_scsi_device(dev);

    int err = -ENODEV;

​

    if (sdev->type != TYPE_ENCLOSURE)

        goto out;

​

    err = 0;

    sdev_printk(KERN_NOTICE, sdev, "Attached Enclosure device\n");

​

 out:

    return err;

}

​

#define SES_TIMEOUT (30 * HZ)

#define SES_RETRIES 3

​

static void init_device_slot_control(unsigned char *dest_desc,

                     struct enclosure_component *ecomp,

                     unsigned char *status)

{

    memcpy(dest_desc, status, 4);

    dest_desc[0] = 0;

    /* only clear byte 1 for ENCLOSURE_COMPONENT_DEVICE */

    if (ecomp->type == ENCLOSURE_COMPONENT_DEVICE)

        dest_desc[1] = 0;

    dest_desc[2] &= 0xde;

    dest_desc[3] &= 0x3c;

}

​

​

static int ses_recv_diag(struct scsi_device *sdev, int page_code,

             void *buf, int bufflen)

{

    int ret;

    unsigned char cmd[] = {

        RECEIVE_DIAGNOSTIC,

        1,      /* Set PCV bit */

        page_code,

        bufflen >> 8,

        bufflen & 0xff,

        0