123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798 |
- /*
- * storage_common.c -- Common definitions for mass storage functionality
- *
- * Copyright (C) 2003-2008 Alan Stern
- * Copyeight (C) 2009 Samsung Electronics
- * Author: Michal Nazarewicz (m.nazarewicz@samsung.com)
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
- */
- /*
- * This file requires the following identifiers used in USB strings to
- * be defined (each of type pointer to char):
- * - fsg_string_manufacturer -- name of the manufacturer
- * - fsg_string_product -- name of the product
- * - fsg_string_config -- name of the configuration
- * - fsg_string_interface -- name of the interface
- * The first four are only needed when FSG_DESCRIPTORS_DEVICE_STRINGS
- * macro is defined prior to including this file.
- */
- /*
- * When FSG_NO_INTR_EP is defined fsg_fs_intr_in_desc and
- * fsg_hs_intr_in_desc objects as well as
- * FSG_FS_FUNCTION_PRE_EP_ENTRIES and FSG_HS_FUNCTION_PRE_EP_ENTRIES
- * macros are not defined.
- *
- * When FSG_NO_DEVICE_STRINGS is defined FSG_STRING_MANUFACTURER,
- * FSG_STRING_PRODUCT, FSG_STRING_SERIAL and FSG_STRING_CONFIG are not
- * defined (as well as corresponding entries in string tables are
- * missing) and FSG_STRING_INTERFACE has value of zero.
- *
- * When FSG_NO_OTG is defined fsg_otg_desc won't be defined.
- */
- /*
- * When FSG_BUFFHD_STATIC_BUFFER is defined when this file is included
- * the fsg_buffhd structure's buf field will be an array of FSG_BUFLEN
- * characters rather then a pointer to void.
- */
- #include <linux/usb/storage.h>
- #include <scsi/scsi.h>
- #include <asm/unaligned.h>
- /*
- * Thanks to NetChip Technologies for donating this product ID.
- *
- * DO NOT REUSE THESE IDs with any other driver!! Ever!!
- * Instead: allocate your own, using normal USB-IF procedures.
- */
- #define FSG_VENDOR_ID 0x0525 /* NetChip */
- #define FSG_PRODUCT_ID 0xa4a5 /* Linux-USB File-backed Storage Gadget */
- /*-------------------------------------------------------------------------*/
- #ifndef DEBUG
- #undef VERBOSE_DEBUG
- #undef DUMP_MSGS
- #endif /* !DEBUG */
- #ifdef VERBOSE_DEBUG
- #define VLDBG LDBG
- #else
- #define VLDBG(lun, fmt, args...) do { } while (0)
- #endif /* VERBOSE_DEBUG */
- #define LDBG(lun, fmt, args...) dev_dbg (&(lun)->dev, fmt, ## args)
- #define LERROR(lun, fmt, args...) dev_err (&(lun)->dev, fmt, ## args)
- #define LWARN(lun, fmt, args...) dev_warn(&(lun)->dev, fmt, ## args)
- #define LINFO(lun, fmt, args...) dev_info(&(lun)->dev, fmt, ## args)
- /*
- * Keep those macros in sync with those in
- * include/linux/usb/composite.h or else GCC will complain. If they
- * are identical (the same names of arguments, white spaces in the
- * same places) GCC will allow redefinition otherwise (even if some
- * white space is removed or added) warning will be issued.
- *
- * Those macros are needed here because File Storage Gadget does not
- * include the composite.h header. For composite gadgets those macros
- * are redundant since composite.h is included any way.
- *
- * One could check whether those macros are already defined (which
- * would indicate composite.h had been included) or not (which would
- * indicate we were in FSG) but this is not done because a warning is
- * desired if definitions here differ from the ones in composite.h.
- *
- * We want the definitions to match and be the same in File Storage
- * Gadget as well as Mass Storage Function (and so composite gadgets
- * using MSF). If someone changes them in composite.h it will produce
- * a warning in this file when building MSF.
- */
- #define DBG(d, fmt, args...) dev_dbg(&(d)->gadget->dev , fmt , ## args)
- #define VDBG(d, fmt, args...) dev_vdbg(&(d)->gadget->dev , fmt , ## args)
- #define ERROR(d, fmt, args...) dev_err(&(d)->gadget->dev , fmt , ## args)
- #define WARNING(d, fmt, args...) dev_warn(&(d)->gadget->dev , fmt , ## args)
- #define INFO(d, fmt, args...) dev_info(&(d)->gadget->dev , fmt , ## args)
- #ifdef DUMP_MSGS
- # define dump_msg(fsg, /* const char * */ label, \
- /* const u8 * */ buf, /* unsigned */ length) do { \
- if (length < 512) { \
- DBG(fsg, "%s, length %u:\n", label, length); \
- print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, \
- 16, 1, buf, length, 0); \
- } \
- } while (0)
- # define dump_cdb(fsg) do { } while (0)
- #else
- # define dump_msg(fsg, /* const char * */ label, \
- /* const u8 * */ buf, /* unsigned */ length) do { } while (0)
- # ifdef VERBOSE_DEBUG
- # define dump_cdb(fsg) \
- print_hex_dump(KERN_DEBUG, "SCSI CDB: ", DUMP_PREFIX_NONE, \
- 16, 1, (fsg)->cmnd, (fsg)->cmnd_size, 0) \
- # else
- # define dump_cdb(fsg) do { } while (0)
- # endif /* VERBOSE_DEBUG */
- #endif /* DUMP_MSGS */
- /*-------------------------------------------------------------------------*/
- /* Bulk-only data structures */
- /* Command Block Wrapper */
- struct fsg_bulk_cb_wrap {
- __le32 Signature; /* Contains 'USBC' */
- u32 Tag; /* Unique per command id */
- __le32 DataTransferLength; /* Size of the data */
- u8 Flags; /* Direction in bit 7 */
- u8 Lun; /* LUN (normally 0) */
- u8 Length; /* Of the CDB, <= MAX_COMMAND_SIZE */
- u8 CDB[16]; /* Command Data Block */
- };
- #define USB_BULK_CB_WRAP_LEN 31
- #define USB_BULK_CB_SIG 0x43425355 /* Spells out USBC */
- #define USB_BULK_IN_FLAG 0x80
- /* Command Status Wrapper */
- struct bulk_cs_wrap {
- __le32 Signature; /* Should = 'USBS' */
- u32 Tag; /* Same as original command */
- __le32 Residue; /* Amount not transferred */
- u8 Status; /* See below */
- };
- #define USB_BULK_CS_WRAP_LEN 13
- #define USB_BULK_CS_SIG 0x53425355 /* Spells out 'USBS' */
- #define USB_STATUS_PASS 0
- #define USB_STATUS_FAIL 1
- #define USB_STATUS_PHASE_ERROR 2
- /* Bulk-only class specific requests */
- #define USB_BULK_RESET_REQUEST 0xff
- #define USB_BULK_GET_MAX_LUN_REQUEST 0xfe
- /* CBI Interrupt data structure */
- struct interrupt_data {
- u8 bType;
- u8 bValue;
- };
- #define CBI_INTERRUPT_DATA_LEN 2
- /* CBI Accept Device-Specific Command request */
- #define USB_CBI_ADSC_REQUEST 0x00
- /* Length of a SCSI Command Data Block */
- #define MAX_COMMAND_SIZE 16
- /* SCSI Sense Key/Additional Sense Code/ASC Qualifier values */
- #define SS_NO_SENSE 0
- #define SS_COMMUNICATION_FAILURE 0x040800
- #define SS_INVALID_COMMAND 0x052000
- #define SS_INVALID_FIELD_IN_CDB 0x052400
- #define SS_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE 0x052100
- #define SS_LOGICAL_UNIT_NOT_SUPPORTED 0x052500
- #define SS_MEDIUM_NOT_PRESENT 0x023a00
- #define SS_MEDIUM_REMOVAL_PREVENTED 0x055302
- #define SS_NOT_READY_TO_READY_TRANSITION 0x062800
- #define SS_RESET_OCCURRED 0x062900
- #define SS_SAVING_PARAMETERS_NOT_SUPPORTED 0x053900
- #define SS_UNRECOVERED_READ_ERROR 0x031100
- #define SS_WRITE_ERROR 0x030c02
- #define SS_WRITE_PROTECTED 0x072700
- #define SK(x) ((u8) ((x) >> 16)) /* Sense Key byte, etc. */
- #define ASC(x) ((u8) ((x) >> 8))
- #define ASCQ(x) ((u8) (x))
- /*-------------------------------------------------------------------------*/
- struct fsg_lun {
- struct file *filp;
- loff_t file_length;
- loff_t num_sectors;
- unsigned int initially_ro:1;
- unsigned int ro:1;
- unsigned int removable:1;
- unsigned int cdrom:1;
- unsigned int prevent_medium_removal:1;
- unsigned int registered:1;
- unsigned int info_valid:1;
- unsigned int nofua:1;
- u32 sense_data;
- u32 sense_data_info;
- u32 unit_attention_data;
- struct device dev;
- };
- #define fsg_lun_is_open(curlun) ((curlun)->filp != NULL)
- static struct fsg_lun *fsg_lun_from_dev(struct device *dev)
- {
- return container_of(dev, struct fsg_lun, dev);
- }
- /* Big enough to hold our biggest descriptor */
- #define EP0_BUFSIZE 256
- #define DELAYED_STATUS (EP0_BUFSIZE + 999) /* An impossibly large value */
- /* Number of buffers we will use. 2 is enough for double-buffering */
- #define FSG_NUM_BUFFERS 2
- /* Default size of buffer length. */
- #define FSG_BUFLEN ((u32)16384)
- /* Maximal number of LUNs supported in mass storage function */
- #define FSG_MAX_LUNS 8
- enum fsg_buffer_state {
- BUF_STATE_EMPTY = 0,
- BUF_STATE_FULL,
- BUF_STATE_BUSY
- };
- struct fsg_buffhd {
- #ifdef FSG_BUFFHD_STATIC_BUFFER
- char buf[FSG_BUFLEN];
- #else
- void *buf;
- #endif
- enum fsg_buffer_state state;
- struct fsg_buffhd *next;
- /*
- * The NetChip 2280 is faster, and handles some protocol faults
- * better, if we don't submit any short bulk-out read requests.
- * So we will record the intended request length here.
- */
- unsigned int bulk_out_intended_length;
- struct usb_request *inreq;
- int inreq_busy;
- struct usb_request *outreq;
- int outreq_busy;
- };
- enum fsg_state {
- /* This one isn't used anywhere */
- FSG_STATE_COMMAND_PHASE = -10,
- FSG_STATE_DATA_PHASE,
- FSG_STATE_STATUS_PHASE,
- FSG_STATE_IDLE = 0,
- FSG_STATE_ABORT_BULK_OUT,
- FSG_STATE_RESET,
- FSG_STATE_INTERFACE_CHANGE,
- FSG_STATE_CONFIG_CHANGE,
- FSG_STATE_DISCONNECT,
- FSG_STATE_EXIT,
- FSG_STATE_TERMINATED
- };
- enum data_direction {
- DATA_DIR_UNKNOWN = 0,
- DATA_DIR_FROM_HOST,
- DATA_DIR_TO_HOST,
- DATA_DIR_NONE
- };
- /*-------------------------------------------------------------------------*/
- static inline u32 get_unaligned_be24(u8 *buf)
- {
- return 0xffffff & (u32) get_unaligned_be32(buf - 1);
- }
- /*-------------------------------------------------------------------------*/
- enum {
- #ifndef FSG_NO_DEVICE_STRINGS
- FSG_STRING_MANUFACTURER = 1,
- FSG_STRING_PRODUCT,
- FSG_STRING_SERIAL,
- FSG_STRING_CONFIG,
- #endif
- FSG_STRING_INTERFACE
- };
- #ifndef FSG_NO_OTG
- static struct usb_otg_descriptor
- fsg_otg_desc = {
- .bLength = sizeof fsg_otg_desc,
- .bDescriptorType = USB_DT_OTG,
- .bmAttributes = USB_OTG_SRP,
- };
- #endif
- /* There is only one interface. */
- static struct usb_interface_descriptor
- fsg_intf_desc = {
- .bLength = sizeof fsg_intf_desc,
- .bDescriptorType = USB_DT_INTERFACE,
- .bNumEndpoints = 2, /* Adjusted during fsg_bind() */
- .bInterfaceClass = USB_CLASS_MASS_STORAGE,
- .bInterfaceSubClass = USB_SC_SCSI, /* Adjusted during fsg_bind() */
- .bInterfaceProtocol = USB_PR_BULK, /* Adjusted during fsg_bind() */
- .iInterface = FSG_STRING_INTERFACE,
- };
- /*
- * Three full-speed endpoint descriptors: bulk-in, bulk-out, and
- * interrupt-in.
- */
- static struct usb_endpoint_descriptor
- fsg_fs_bulk_in_desc = {
- .bLength = USB_DT_ENDPOINT_SIZE,
- .bDescriptorType = USB_DT_ENDPOINT,
- .bEndpointAddress = USB_DIR_IN,
- .bmAttributes = USB_ENDPOINT_XFER_BULK,
- /* wMaxPacketSize set by autoconfiguration */
- };
- static struct usb_endpoint_descriptor
- fsg_fs_bulk_out_desc = {
- .bLength = USB_DT_ENDPOINT_SIZE,
- .bDescriptorType = USB_DT_ENDPOINT,
- .bEndpointAddress = USB_DIR_OUT,
- .bmAttributes = USB_ENDPOINT_XFER_BULK,
- /* wMaxPacketSize set by autoconfiguration */
- };
- #ifndef FSG_NO_INTR_EP
- static struct usb_endpoint_descriptor
- fsg_fs_intr_in_desc = {
- .bLength = USB_DT_ENDPOINT_SIZE,
- .bDescriptorType = USB_DT_ENDPOINT,
- .bEndpointAddress = USB_DIR_IN,
- .bmAttributes = USB_ENDPOINT_XFER_INT,
- .wMaxPacketSize = cpu_to_le16(2),
- .bInterval = 32, /* frames -> 32 ms */
- };
- #ifndef FSG_NO_OTG
- # define FSG_FS_FUNCTION_PRE_EP_ENTRIES 2
- #else
- # define FSG_FS_FUNCTION_PRE_EP_ENTRIES 1
- #endif
- #endif
- static struct usb_descriptor_header *fsg_fs_function[] = {
- #ifndef FSG_NO_OTG
- (struct usb_descriptor_header *) &fsg_otg_desc,
- #endif
- (struct usb_descriptor_header *) &fsg_intf_desc,
- (struct usb_descriptor_header *) &fsg_fs_bulk_in_desc,
- (struct usb_descriptor_header *) &fsg_fs_bulk_out_desc,
- #ifndef FSG_NO_INTR_EP
- (struct usb_descriptor_header *) &fsg_fs_intr_in_desc,
- #endif
- NULL,
- };
- /*
- * USB 2.0 devices need to expose both high speed and full speed
- * descriptors, unless they only run at full speed.
- *
- * That means alternate endpoint descriptors (bigger packets)
- * and a "device qualifier" ... plus more construction options
- * for the configuration descriptor.
- */
- static struct usb_endpoint_descriptor
- fsg_hs_bulk_in_desc = {
- .bLength = USB_DT_ENDPOINT_SIZE,
- .bDescriptorType = USB_DT_ENDPOINT,
- /* bEndpointAddress copied from fs_bulk_in_desc during fsg_bind() */
- .bmAttributes = USB_ENDPOINT_XFER_BULK,
- .wMaxPacketSize = cpu_to_le16(512),
- };
- static struct usb_endpoint_descriptor
- fsg_hs_bulk_out_desc = {
- .bLength = USB_DT_ENDPOINT_SIZE,
- .bDescriptorType = USB_DT_ENDPOINT,
- /* bEndpointAddress copied from fs_bulk_out_desc during fsg_bind() */
- .bmAttributes = USB_ENDPOINT_XFER_BULK,
- .wMaxPacketSize = cpu_to_le16(512),
- .bInterval = 1, /* NAK every 1 uframe */
- };
- #ifndef FSG_NO_INTR_EP
- static struct usb_endpoint_descriptor
- fsg_hs_intr_in_desc = {
- .bLength = USB_DT_ENDPOINT_SIZE,
- .bDescriptorType = USB_DT_ENDPOINT,
- /* bEndpointAddress copied from fs_intr_in_desc during fsg_bind() */
- .bmAttributes = USB_ENDPOINT_XFER_INT,
- .wMaxPacketSize = cpu_to_le16(2),
- .bInterval = 9, /* 2**(9-1) = 256 uframes -> 32 ms */
- };
- #ifndef FSG_NO_OTG
- # define FSG_HS_FUNCTION_PRE_EP_ENTRIES 2
- #else
- # define FSG_HS_FUNCTION_PRE_EP_ENTRIES 1
- #endif
- #endif
- static struct usb_descriptor_header *fsg_hs_function[] = {
- #ifndef FSG_NO_OTG
- (struct usb_descriptor_header *) &fsg_otg_desc,
- #endif
- (struct usb_descriptor_header *) &fsg_intf_desc,
- (struct usb_descriptor_header *) &fsg_hs_bulk_in_desc,
- (struct usb_descriptor_header *) &fsg_hs_bulk_out_desc,
- #ifndef FSG_NO_INTR_EP
- (struct usb_descriptor_header *) &fsg_hs_intr_in_desc,
- #endif
- NULL,
- };
- /* Maxpacket and other transfer characteristics vary by speed. */
- static struct usb_endpoint_descriptor *
- fsg_ep_desc(struct usb_gadget *g, struct usb_endpoint_descriptor *fs,
- struct usb_endpoint_descriptor *hs)
- {
- if (gadget_is_dualspeed(g) && g->speed == USB_SPEED_HIGH)
- return hs;
- return fs;
- }
- /* Static strings, in UTF-8 (for simplicity we use only ASCII characters) */
- static struct usb_string fsg_strings[] = {
- #ifndef FSG_NO_DEVICE_STRINGS
- {FSG_STRING_MANUFACTURER, fsg_string_manufacturer},
- {FSG_STRING_PRODUCT, fsg_string_product},
- {FSG_STRING_SERIAL, ""},
- {FSG_STRING_CONFIG, fsg_string_config},
- #endif
- {FSG_STRING_INTERFACE, fsg_string_interface},
- {}
- };
- static struct usb_gadget_strings fsg_stringtab = {
- .language = 0x0409, /* en-us */
- .strings = fsg_strings,
- };
- /*-------------------------------------------------------------------------*/
- /*
- * If the next two routines are called while the gadget is registered,
- * the caller must own fsg->filesem for writing.
- */
- static int fsg_lun_open(struct fsg_lun *curlun, const char *filename)
- {
- int ro;
- struct file *filp = NULL;
- int rc = -EINVAL;
- struct inode *inode = NULL;
- loff_t size;
- loff_t num_sectors;
- loff_t min_sectors;
- /* R/W if we can, R/O if we must */
- ro = curlun->initially_ro;
- if (!ro) {
- filp = filp_open(filename, O_RDWR | O_LARGEFILE, 0);
- if (PTR_ERR(filp) == -EROFS || PTR_ERR(filp) == -EACCES)
- ro = 1;
- }
- if (ro)
- filp = filp_open(filename, O_RDONLY | O_LARGEFILE, 0);
- if (IS_ERR(filp)) {
- LINFO(curlun, "unable to open backing file: %s\n", filename);
- return PTR_ERR(filp);
- }
- if (!(filp->f_mode & FMODE_WRITE))
- ro = 1;
- if (filp->f_path.dentry)
- inode = filp->f_path.dentry->d_inode;
- if (!inode || (!S_ISREG(inode->i_mode) && !S_ISBLK(inode->i_mode))) {
- LINFO(curlun, "invalid file type: %s\n", filename);
- goto out;
- }
- /*
- * If we can't read the file, it's no good.
- * If we can't write the file, use it read-only.
- */
- if (!filp->f_op || !(filp->f_op->read || filp->f_op->aio_read)) {
- LINFO(curlun, "file not readable: %s\n", filename);
- goto out;
- }
- if (!(filp->f_op->write || filp->f_op->aio_write))
- ro = 1;
- size = i_size_read(inode->i_mapping->host);
- if (size < 0) {
- LINFO(curlun, "unable to find file size: %s\n", filename);
- rc = (int) size;
- goto out;
- }
- num_sectors = size >> 9; /* File size in 512-byte blocks */
- min_sectors = 1;
- if (curlun->cdrom) {
- num_sectors &= ~3; /* Reduce to a multiple of 2048 */
- min_sectors = 300*4; /* Smallest track is 300 frames */
- if (num_sectors >= 256*60*75*4) {
- num_sectors = (256*60*75 - 1) * 4;
- LINFO(curlun, "file too big: %s\n", filename);
- LINFO(curlun, "using only first %d blocks\n",
- (int) num_sectors);
- }
- }
- if (num_sectors < min_sectors) {
- LINFO(curlun, "file too small: %s\n", filename);
- rc = -ETOOSMALL;
- goto out;
- }
- get_file(filp);
- curlun->ro = ro;
- curlun->filp = filp;
- curlun->file_length = size;
- curlun->num_sectors = num_sectors;
- LDBG(curlun, "open backing file: %s\n", filename);
- rc = 0;
- out:
- filp_close(filp, current->files);
- return rc;
- }
- static void fsg_lun_close(struct fsg_lun *curlun)
- {
- if (curlun->filp) {
- LDBG(curlun, "close backing file\n");
- fput(curlun->filp);
- curlun->filp = NULL;
- }
- }
- /*-------------------------------------------------------------------------*/
- /*
- * Sync the file data, don't bother with the metadata.
- * This code was copied from fs/buffer.c:sys_fdatasync().
- */
- static int fsg_lun_fsync_sub(struct fsg_lun *curlun)
- {
- struct file *filp = curlun->filp;
- if (curlun->ro || !filp)
- return 0;
- return vfs_fsync(filp, 1);
- }
- static void store_cdrom_address(u8 *dest, int msf, u32 addr)
- {
- if (msf) {
- /* Convert to Minutes-Seconds-Frames */
- addr >>= 2; /* Convert to 2048-byte frames */
- addr += 2*75; /* Lead-in occupies 2 seconds */
- dest[3] = addr % 75; /* Frames */
- addr /= 75;
- dest[2] = addr % 60; /* Seconds */
- addr /= 60;
- dest[1] = addr; /* Minutes */
- dest[0] = 0; /* Reserved */
- } else {
- /* Absolute sector */
- put_unaligned_be32(addr, dest);
- }
- }
- /*-------------------------------------------------------------------------*/
- static ssize_t fsg_show_ro(struct device *dev, struct device_attribute *attr,
- char *buf)
- {
- struct fsg_lun *curlun = fsg_lun_from_dev(dev);
- return sprintf(buf, "%d\n", fsg_lun_is_open(curlun)
- ? curlun->ro
- : curlun->initially_ro);
- }
- static ssize_t fsg_show_nofua(struct device *dev, struct device_attribute *attr,
- char *buf)
- {
- struct fsg_lun *curlun = fsg_lun_from_dev(dev);
- return sprintf(buf, "%u\n", curlun->nofua);
- }
- static ssize_t fsg_show_file(struct device *dev, struct device_attribute *attr,
- char *buf)
- {
- struct fsg_lun *curlun = fsg_lun_from_dev(dev);
- struct rw_semaphore *filesem = dev_get_drvdata(dev);
- char *p;
- ssize_t rc;
- down_read(filesem);
- if (fsg_lun_is_open(curlun)) { /* Get the complete pathname */
- p = d_path(&curlun->filp->f_path, buf, PAGE_SIZE - 1);
- if (IS_ERR(p))
- rc = PTR_ERR(p);
- else {
- rc = strlen(p);
- memmove(buf, p, rc);
- buf[rc] = '\n'; /* Add a newline */
- buf[++rc] = 0;
- }
- } else { /* No file, return 0 bytes */
- *buf = 0;
- rc = 0;
- }
- up_read(filesem);
- return rc;
- }
- static ssize_t fsg_store_ro(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- ssize_t rc;
- struct fsg_lun *curlun = fsg_lun_from_dev(dev);
- struct rw_semaphore *filesem = dev_get_drvdata(dev);
- unsigned ro;
- rc = kstrtouint(buf, 2, &ro);
- if (rc)
- return rc;
- /*
- * Allow the write-enable status to change only while the
- * backing file is closed.
- */
- down_read(filesem);
- if (fsg_lun_is_open(curlun)) {
- LDBG(curlun, "read-only status change prevented\n");
- rc = -EBUSY;
- } else {
- curlun->ro = ro;
- curlun->initially_ro = ro;
- LDBG(curlun, "read-only status set to %d\n", curlun->ro);
- rc = count;
- }
- up_read(filesem);
- return rc;
- }
- static ssize_t fsg_store_nofua(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct fsg_lun *curlun = fsg_lun_from_dev(dev);
- unsigned nofua;
- int ret;
- ret = kstrtouint(buf, 2, &nofua);
- if (ret)
- return ret;
- /* Sync data when switching from async mode to sync */
- if (!nofua && curlun->nofua)
- fsg_lun_fsync_sub(curlun);
- curlun->nofua = nofua;
- return count;
- }
- static ssize_t fsg_store_file(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct fsg_lun *curlun = fsg_lun_from_dev(dev);
- struct rw_semaphore *filesem = dev_get_drvdata(dev);
- int rc = 0;
- #ifndef CONFIG_USB_ANDROID_MASS_STORAGE
- /* disabled in android because we need to allow closing the backing file
- * if the media was removed
- */
- if (curlun->prevent_medium_removal && fsg_lun_is_open(curlun)) {
- LDBG(curlun, "eject attempt prevented\n");
- return -EBUSY; /* "Door is locked" */
- }
- #endif
- /* Remove a trailing newline */
- if (count > 0 && buf[count-1] == '\n')
- ((char *) buf)[count-1] = 0; /* Ugh! */
- /* Eject current medium */
- down_write(filesem);
- if (fsg_lun_is_open(curlun)) {
- fsg_lun_close(curlun);
- curlun->unit_attention_data = SS_MEDIUM_NOT_PRESENT;
- }
- /* Load new medium */
- if (count > 0 && buf[0]) {
- rc = fsg_lun_open(curlun, buf);
- if (rc == 0)
- curlun->unit_attention_data =
- SS_NOT_READY_TO_READY_TRANSITION;
- }
- up_write(filesem);
- return (rc < 0 ? rc : count);
- }
|