root/drivers/usb/storage/karma.c
// SPDX-License-Identifier: GPL-2.0+
/*
 * Driver for Rio Karma
 *
 *   (c) 2006 Bob Copeland <me@bobcopeland.com>
 *   (c) 2006 Keith Bennett <keith@mcs.st-and.ac.uk>
 */

#include <linux/module.h>
#include <linux/slab.h>

#include <scsi/scsi.h>
#include <scsi/scsi_cmnd.h>
#include <scsi/scsi_device.h>

#include "usb.h"
#include "transport.h"
#include "debug.h"
#include "scsiglue.h"

#define DRV_NAME "ums-karma"

MODULE_DESCRIPTION("Driver for Rio Karma");
MODULE_AUTHOR("Bob Copeland <me@bobcopeland.com>, Keith Bennett <keith@mcs.st-and.ac.uk>");
MODULE_LICENSE("GPL");
MODULE_IMPORT_NS("USB_STORAGE");

#define RIO_PREFIX "RIOP\x00"
#define RIO_PREFIX_LEN 5
#define RIO_SEND_LEN 40
#define RIO_RECV_LEN 0x200

#define RIO_ENTER_STORAGE 0x1
#define RIO_LEAVE_STORAGE 0x2
#define RIO_RESET 0xC

struct karma_data {
        int in_storage;
        char *recv;
};

static int rio_karma_init(struct us_data *us);


/*
 * The table of devices
 */
#define UNUSUAL_DEV(id_vendor, id_product, bcdDeviceMin, bcdDeviceMax, \
                    vendorName, productName, useProtocol, useTransport, \
                    initFunction, flags) \
{ USB_DEVICE_VER(id_vendor, id_product, bcdDeviceMin, bcdDeviceMax), \
  .driver_info = (flags) }

static const struct usb_device_id karma_usb_ids[] = {
#       include "unusual_karma.h"
        { }             /* Terminating entry */
};
MODULE_DEVICE_TABLE(usb, karma_usb_ids);

#undef UNUSUAL_DEV

/*
 * The flags table
 */
#define UNUSUAL_DEV(idVendor, idProduct, bcdDeviceMin, bcdDeviceMax, \
                    vendor_name, product_name, use_protocol, use_transport, \
                    init_function, Flags) \
{ \
        .vendorName = vendor_name,      \
        .productName = product_name,    \
        .useProtocol = use_protocol,    \
        .useTransport = use_transport,  \
        .initFunction = init_function,  \
}

static const struct us_unusual_dev karma_unusual_dev_list[] = {
#       include "unusual_karma.h"
        { }             /* Terminating entry */
};

#undef UNUSUAL_DEV


/*
 * Send commands to Rio Karma.
 *
 * For each command we send 40 bytes starting 'RIOP\0' followed by
 * the command number and a sequence number, which the device will ack
 * with a 512-byte packet with the high four bits set and everything
 * else null.  Then we send 'RIOP\x80' followed by a zero and the
 * sequence number, until byte 5 in the response repeats the sequence
 * number.
 */
static int rio_karma_send_command(char cmd, struct us_data *us)
{
        int result;
        unsigned long timeout;
        static unsigned char seq = 1;
        struct karma_data *data = (struct karma_data *) us->extra;

        usb_stor_dbg(us, "sending command %04x\n", cmd);
        memset(us->iobuf, 0, RIO_SEND_LEN);
        memcpy(us->iobuf, RIO_PREFIX, RIO_PREFIX_LEN);
        us->iobuf[5] = cmd;
        us->iobuf[6] = seq;

        timeout = jiffies + msecs_to_jiffies(6000);
        for (;;) {
                result = usb_stor_bulk_transfer_buf(us, us->send_bulk_pipe,
                        us->iobuf, RIO_SEND_LEN, NULL);
                if (result != USB_STOR_XFER_GOOD)
                        goto err;

                result = usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
                        data->recv, RIO_RECV_LEN, NULL);
                if (result != USB_STOR_XFER_GOOD)
                        goto err;

                if (data->recv[5] == seq)
                        break;

                if (time_after(jiffies, timeout))
                        goto err;

                us->iobuf[4] = 0x80;
                us->iobuf[5] = 0;
                msleep(50);
        }

        seq++;
        if (seq == 0)
                seq = 1;

        usb_stor_dbg(us, "sent command %04x\n", cmd);
        return 0;
err:
        usb_stor_dbg(us, "command %04x failed\n", cmd);
        return USB_STOR_TRANSPORT_FAILED;
}

/*
 * Trap START_STOP and READ_10 to leave/re-enter storage mode.
 * Everything else is propagated to the normal bulk layer.
 */
static int rio_karma_transport(struct scsi_cmnd *srb, struct us_data *us)
{
        int ret;
        struct karma_data *data = (struct karma_data *) us->extra;

        if (srb->cmnd[0] == READ_10 && !data->in_storage) {
                ret = rio_karma_send_command(RIO_ENTER_STORAGE, us);
                if (ret)
                        return ret;

                data->in_storage = 1;
                return usb_stor_Bulk_transport(srb, us);
        } else if (srb->cmnd[0] == START_STOP) {
                ret = rio_karma_send_command(RIO_LEAVE_STORAGE, us);
                if (ret)
                        return ret;

                data->in_storage = 0;
                return rio_karma_send_command(RIO_RESET, us);
        }
        return usb_stor_Bulk_transport(srb, us);
}

static void rio_karma_destructor(void *extra)
{
        struct karma_data *data = (struct karma_data *) extra;

        kfree(data->recv);
}

static int rio_karma_init(struct us_data *us)
{
        struct karma_data *data = kzalloc_obj(struct karma_data, GFP_NOIO);

        if (!data)
                return -ENOMEM;

        data->recv = kmalloc(RIO_RECV_LEN, GFP_NOIO);
        if (!data->recv) {
                kfree(data);
                return -ENOMEM;
        }

        us->extra = data;
        us->extra_destructor = rio_karma_destructor;
        if (rio_karma_send_command(RIO_ENTER_STORAGE, us))
                return -EIO;

        data->in_storage = 1;

        return 0;
}

static struct scsi_host_template karma_host_template;

static int karma_probe(struct usb_interface *intf,
                         const struct usb_device_id *id)
{
        struct us_data *us;
        int result;

        result = usb_stor_probe1(&us, intf, id,
                        (id - karma_usb_ids) + karma_unusual_dev_list,
                        &karma_host_template);
        if (result)
                return result;

        us->transport_name = "Rio Karma/Bulk";
        us->transport = rio_karma_transport;
        us->transport_reset = usb_stor_Bulk_reset;

        result = usb_stor_probe2(us);
        return result;
}

static struct usb_driver karma_driver = {
        .name =         DRV_NAME,
        .probe =        karma_probe,
        .disconnect =   usb_stor_disconnect,
        .suspend =      usb_stor_suspend,
        .resume =       usb_stor_resume,
        .reset_resume = usb_stor_reset_resume,
        .pre_reset =    usb_stor_pre_reset,
        .post_reset =   usb_stor_post_reset,
        .id_table =     karma_usb_ids,
        .soft_unbind =  1,
        .no_dynamic_id = 1,
};

module_usb_stor_driver(karma_driver, karma_host_template, DRV_NAME);