dev-storage.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805
  1. /*
  2. * USB Mass Storage Device emulation
  3. *
  4. * Copyright (c) 2006 CodeSourcery.
  5. * Written by Paul Brook
  6. *
  7. * This code is licensed under the LGPL.
  8. */
  9. #include "qemu/osdep.h"
  10. #include "qapi/error.h"
  11. #include "qemu/error-report.h"
  12. #include "qemu/module.h"
  13. #include "qemu/option.h"
  14. #include "qemu/config-file.h"
  15. #include "hw/usb.h"
  16. #include "desc.h"
  17. #include "hw/qdev-properties.h"
  18. #include "hw/scsi/scsi.h"
  19. #include "migration/vmstate.h"
  20. #include "sysemu/sysemu.h"
  21. #include "sysemu/block-backend.h"
  22. #include "qapi/visitor.h"
  23. #include "qemu/cutils.h"
  24. #include "qom/object.h"
  25. //#define DEBUG_MSD
  26. #ifdef DEBUG_MSD
  27. #define DPRINTF(fmt, ...) \
  28. do { printf("usb-msd: " fmt , ## __VA_ARGS__); } while (0)
  29. #else
  30. #define DPRINTF(fmt, ...) do {} while(0)
  31. #endif
  32. /* USB requests. */
  33. #define MassStorageReset 0xff
  34. #define GetMaxLun 0xfe
  35. enum USBMSDMode {
  36. USB_MSDM_CBW, /* Command Block. */
  37. USB_MSDM_DATAOUT, /* Transfer data to device. */
  38. USB_MSDM_DATAIN, /* Transfer data from device. */
  39. USB_MSDM_CSW /* Command Status. */
  40. };
  41. struct usb_msd_csw {
  42. uint32_t sig;
  43. uint32_t tag;
  44. uint32_t residue;
  45. uint8_t status;
  46. };
  47. struct MSDState {
  48. USBDevice dev;
  49. enum USBMSDMode mode;
  50. uint32_t scsi_off;
  51. uint32_t scsi_len;
  52. uint32_t data_len;
  53. struct usb_msd_csw csw;
  54. SCSIRequest *req;
  55. SCSIBus bus;
  56. /* For async completion. */
  57. USBPacket *packet;
  58. /* usb-storage only */
  59. BlockConf conf;
  60. uint32_t removable;
  61. SCSIDevice *scsi_dev;
  62. };
  63. typedef struct MSDState MSDState;
  64. #define TYPE_USB_STORAGE "usb-storage-dev"
  65. DECLARE_INSTANCE_CHECKER(MSDState, USB_STORAGE_DEV,
  66. TYPE_USB_STORAGE)
  67. struct usb_msd_cbw {
  68. uint32_t sig;
  69. uint32_t tag;
  70. uint32_t data_len;
  71. uint8_t flags;
  72. uint8_t lun;
  73. uint8_t cmd_len;
  74. uint8_t cmd[16];
  75. };
  76. enum {
  77. STR_MANUFACTURER = 1,
  78. STR_PRODUCT,
  79. STR_SERIALNUMBER,
  80. STR_CONFIG_FULL,
  81. STR_CONFIG_HIGH,
  82. STR_CONFIG_SUPER,
  83. };
  84. static const USBDescStrings desc_strings = {
  85. [STR_MANUFACTURER] = "QEMU",
  86. [STR_PRODUCT] = "QEMU USB HARDDRIVE",
  87. [STR_SERIALNUMBER] = "1",
  88. [STR_CONFIG_FULL] = "Full speed config (usb 1.1)",
  89. [STR_CONFIG_HIGH] = "High speed config (usb 2.0)",
  90. [STR_CONFIG_SUPER] = "Super speed config (usb 3.0)",
  91. };
  92. static const USBDescIface desc_iface_full = {
  93. .bInterfaceNumber = 0,
  94. .bNumEndpoints = 2,
  95. .bInterfaceClass = USB_CLASS_MASS_STORAGE,
  96. .bInterfaceSubClass = 0x06, /* SCSI */
  97. .bInterfaceProtocol = 0x50, /* Bulk */
  98. .eps = (USBDescEndpoint[]) {
  99. {
  100. .bEndpointAddress = USB_DIR_IN | 0x01,
  101. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  102. .wMaxPacketSize = 64,
  103. },{
  104. .bEndpointAddress = USB_DIR_OUT | 0x02,
  105. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  106. .wMaxPacketSize = 64,
  107. },
  108. }
  109. };
  110. static const USBDescDevice desc_device_full = {
  111. .bcdUSB = 0x0200,
  112. .bMaxPacketSize0 = 8,
  113. .bNumConfigurations = 1,
  114. .confs = (USBDescConfig[]) {
  115. {
  116. .bNumInterfaces = 1,
  117. .bConfigurationValue = 1,
  118. .iConfiguration = STR_CONFIG_FULL,
  119. .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
  120. .nif = 1,
  121. .ifs = &desc_iface_full,
  122. },
  123. },
  124. };
  125. static const USBDescIface desc_iface_high = {
  126. .bInterfaceNumber = 0,
  127. .bNumEndpoints = 2,
  128. .bInterfaceClass = USB_CLASS_MASS_STORAGE,
  129. .bInterfaceSubClass = 0x06, /* SCSI */
  130. .bInterfaceProtocol = 0x50, /* Bulk */
  131. .eps = (USBDescEndpoint[]) {
  132. {
  133. .bEndpointAddress = USB_DIR_IN | 0x01,
  134. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  135. .wMaxPacketSize = 512,
  136. },{
  137. .bEndpointAddress = USB_DIR_OUT | 0x02,
  138. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  139. .wMaxPacketSize = 512,
  140. },
  141. }
  142. };
  143. static const USBDescDevice desc_device_high = {
  144. .bcdUSB = 0x0200,
  145. .bMaxPacketSize0 = 64,
  146. .bNumConfigurations = 1,
  147. .confs = (USBDescConfig[]) {
  148. {
  149. .bNumInterfaces = 1,
  150. .bConfigurationValue = 1,
  151. .iConfiguration = STR_CONFIG_HIGH,
  152. .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
  153. .nif = 1,
  154. .ifs = &desc_iface_high,
  155. },
  156. },
  157. };
  158. static const USBDescIface desc_iface_super = {
  159. .bInterfaceNumber = 0,
  160. .bNumEndpoints = 2,
  161. .bInterfaceClass = USB_CLASS_MASS_STORAGE,
  162. .bInterfaceSubClass = 0x06, /* SCSI */
  163. .bInterfaceProtocol = 0x50, /* Bulk */
  164. .eps = (USBDescEndpoint[]) {
  165. {
  166. .bEndpointAddress = USB_DIR_IN | 0x01,
  167. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  168. .wMaxPacketSize = 1024,
  169. .bMaxBurst = 15,
  170. },{
  171. .bEndpointAddress = USB_DIR_OUT | 0x02,
  172. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  173. .wMaxPacketSize = 1024,
  174. .bMaxBurst = 15,
  175. },
  176. }
  177. };
  178. static const USBDescDevice desc_device_super = {
  179. .bcdUSB = 0x0300,
  180. .bMaxPacketSize0 = 9,
  181. .bNumConfigurations = 1,
  182. .confs = (USBDescConfig[]) {
  183. {
  184. .bNumInterfaces = 1,
  185. .bConfigurationValue = 1,
  186. .iConfiguration = STR_CONFIG_SUPER,
  187. .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
  188. .nif = 1,
  189. .ifs = &desc_iface_super,
  190. },
  191. },
  192. };
  193. static const USBDesc desc = {
  194. .id = {
  195. .idVendor = 0x46f4, /* CRC16() of "QEMU" */
  196. .idProduct = 0x0001,
  197. .bcdDevice = 0,
  198. .iManufacturer = STR_MANUFACTURER,
  199. .iProduct = STR_PRODUCT,
  200. .iSerialNumber = STR_SERIALNUMBER,
  201. },
  202. .full = &desc_device_full,
  203. .high = &desc_device_high,
  204. .super = &desc_device_super,
  205. .str = desc_strings,
  206. };
  207. static void usb_msd_copy_data(MSDState *s, USBPacket *p)
  208. {
  209. uint32_t len;
  210. len = p->iov.size - p->actual_length;
  211. if (len > s->scsi_len)
  212. len = s->scsi_len;
  213. usb_packet_copy(p, scsi_req_get_buf(s->req) + s->scsi_off, len);
  214. s->scsi_len -= len;
  215. s->scsi_off += len;
  216. if (len > s->data_len) {
  217. len = s->data_len;
  218. }
  219. s->data_len -= len;
  220. if (s->scsi_len == 0 || s->data_len == 0) {
  221. scsi_req_continue(s->req);
  222. }
  223. }
  224. static void usb_msd_send_status(MSDState *s, USBPacket *p)
  225. {
  226. int len;
  227. DPRINTF("Command status %d tag 0x%x, len %zd\n",
  228. s->csw.status, le32_to_cpu(s->csw.tag), p->iov.size);
  229. assert(s->csw.sig == cpu_to_le32(0x53425355));
  230. len = MIN(sizeof(s->csw), p->iov.size);
  231. usb_packet_copy(p, &s->csw, len);
  232. memset(&s->csw, 0, sizeof(s->csw));
  233. }
  234. static void usb_msd_packet_complete(MSDState *s)
  235. {
  236. USBPacket *p = s->packet;
  237. /* Set s->packet to NULL before calling usb_packet_complete
  238. because another request may be issued before
  239. usb_packet_complete returns. */
  240. DPRINTF("Packet complete %p\n", p);
  241. s->packet = NULL;
  242. usb_packet_complete(&s->dev, p);
  243. }
  244. static void usb_msd_transfer_data(SCSIRequest *req, uint32_t len)
  245. {
  246. MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
  247. USBPacket *p = s->packet;
  248. assert((s->mode == USB_MSDM_DATAOUT) == (req->cmd.mode == SCSI_XFER_TO_DEV));
  249. s->scsi_len = len;
  250. s->scsi_off = 0;
  251. if (p) {
  252. usb_msd_copy_data(s, p);
  253. p = s->packet;
  254. if (p && p->actual_length == p->iov.size) {
  255. p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
  256. usb_msd_packet_complete(s);
  257. }
  258. }
  259. }
  260. static void usb_msd_command_complete(SCSIRequest *req, uint32_t status, size_t resid)
  261. {
  262. MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
  263. USBPacket *p = s->packet;
  264. DPRINTF("Command complete %d tag 0x%x\n", status, req->tag);
  265. s->csw.sig = cpu_to_le32(0x53425355);
  266. s->csw.tag = cpu_to_le32(req->tag);
  267. s->csw.residue = cpu_to_le32(s->data_len);
  268. s->csw.status = status != 0;
  269. if (s->packet) {
  270. if (s->data_len == 0 && s->mode == USB_MSDM_DATAOUT) {
  271. /* A deferred packet with no write data remaining must be
  272. the status read packet. */
  273. usb_msd_send_status(s, p);
  274. s->mode = USB_MSDM_CBW;
  275. } else if (s->mode == USB_MSDM_CSW) {
  276. usb_msd_send_status(s, p);
  277. s->mode = USB_MSDM_CBW;
  278. } else {
  279. if (s->data_len) {
  280. int len = (p->iov.size - p->actual_length);
  281. usb_packet_skip(p, len);
  282. if (len > s->data_len) {
  283. len = s->data_len;
  284. }
  285. s->data_len -= len;
  286. }
  287. if (s->data_len == 0) {
  288. s->mode = USB_MSDM_CSW;
  289. }
  290. }
  291. p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
  292. usb_msd_packet_complete(s);
  293. } else if (s->data_len == 0) {
  294. s->mode = USB_MSDM_CSW;
  295. }
  296. scsi_req_unref(req);
  297. s->req = NULL;
  298. }
  299. static void usb_msd_request_cancelled(SCSIRequest *req)
  300. {
  301. MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
  302. if (req == s->req) {
  303. scsi_req_unref(s->req);
  304. s->req = NULL;
  305. s->scsi_len = 0;
  306. }
  307. }
  308. static void usb_msd_handle_reset(USBDevice *dev)
  309. {
  310. MSDState *s = (MSDState *)dev;
  311. DPRINTF("Reset\n");
  312. if (s->req) {
  313. scsi_req_cancel(s->req);
  314. }
  315. assert(s->req == NULL);
  316. if (s->packet) {
  317. s->packet->status = USB_RET_STALL;
  318. usb_msd_packet_complete(s);
  319. }
  320. s->mode = USB_MSDM_CBW;
  321. }
  322. static void usb_msd_handle_control(USBDevice *dev, USBPacket *p,
  323. int request, int value, int index, int length, uint8_t *data)
  324. {
  325. MSDState *s = (MSDState *)dev;
  326. SCSIDevice *scsi_dev;
  327. int ret, maxlun;
  328. ret = usb_desc_handle_control(dev, p, request, value, index, length, data);
  329. if (ret >= 0) {
  330. return;
  331. }
  332. switch (request) {
  333. case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
  334. break;
  335. /* Class specific requests. */
  336. case ClassInterfaceOutRequest | MassStorageReset:
  337. /* Reset state ready for the next CBW. */
  338. s->mode = USB_MSDM_CBW;
  339. break;
  340. case ClassInterfaceRequest | GetMaxLun:
  341. maxlun = 0;
  342. for (;;) {
  343. scsi_dev = scsi_device_find(&s->bus, 0, 0, maxlun+1);
  344. if (scsi_dev == NULL) {
  345. break;
  346. }
  347. if (scsi_dev->lun != maxlun+1) {
  348. break;
  349. }
  350. maxlun++;
  351. }
  352. DPRINTF("MaxLun %d\n", maxlun);
  353. data[0] = maxlun;
  354. p->actual_length = 1;
  355. break;
  356. default:
  357. p->status = USB_RET_STALL;
  358. break;
  359. }
  360. }
  361. static void usb_msd_cancel_io(USBDevice *dev, USBPacket *p)
  362. {
  363. MSDState *s = USB_STORAGE_DEV(dev);
  364. assert(s->packet == p);
  365. s->packet = NULL;
  366. if (s->req) {
  367. scsi_req_cancel(s->req);
  368. }
  369. }
  370. static void usb_msd_handle_data(USBDevice *dev, USBPacket *p)
  371. {
  372. MSDState *s = (MSDState *)dev;
  373. uint32_t tag;
  374. struct usb_msd_cbw cbw;
  375. uint8_t devep = p->ep->nr;
  376. SCSIDevice *scsi_dev;
  377. uint32_t len;
  378. switch (p->pid) {
  379. case USB_TOKEN_OUT:
  380. if (devep != 2)
  381. goto fail;
  382. switch (s->mode) {
  383. case USB_MSDM_CBW:
  384. if (p->iov.size != 31) {
  385. error_report("usb-msd: Bad CBW size");
  386. goto fail;
  387. }
  388. usb_packet_copy(p, &cbw, 31);
  389. if (le32_to_cpu(cbw.sig) != 0x43425355) {
  390. error_report("usb-msd: Bad signature %08x",
  391. le32_to_cpu(cbw.sig));
  392. goto fail;
  393. }
  394. DPRINTF("Command on LUN %d\n", cbw.lun);
  395. scsi_dev = scsi_device_find(&s->bus, 0, 0, cbw.lun);
  396. if (scsi_dev == NULL) {
  397. error_report("usb-msd: Bad LUN %d", cbw.lun);
  398. goto fail;
  399. }
  400. tag = le32_to_cpu(cbw.tag);
  401. s->data_len = le32_to_cpu(cbw.data_len);
  402. if (s->data_len == 0) {
  403. s->mode = USB_MSDM_CSW;
  404. } else if (cbw.flags & 0x80) {
  405. s->mode = USB_MSDM_DATAIN;
  406. } else {
  407. s->mode = USB_MSDM_DATAOUT;
  408. }
  409. DPRINTF("Command tag 0x%x flags %08x len %d data %d\n",
  410. tag, cbw.flags, cbw.cmd_len, s->data_len);
  411. assert(le32_to_cpu(s->csw.residue) == 0);
  412. s->scsi_len = 0;
  413. s->req = scsi_req_new(scsi_dev, tag, cbw.lun, cbw.cmd, NULL);
  414. #ifdef DEBUG_MSD
  415. scsi_req_print(s->req);
  416. #endif
  417. len = scsi_req_enqueue(s->req);
  418. if (len) {
  419. scsi_req_continue(s->req);
  420. }
  421. break;
  422. case USB_MSDM_DATAOUT:
  423. DPRINTF("Data out %zd/%d\n", p->iov.size, s->data_len);
  424. if (p->iov.size > s->data_len) {
  425. goto fail;
  426. }
  427. if (s->scsi_len) {
  428. usb_msd_copy_data(s, p);
  429. }
  430. if (le32_to_cpu(s->csw.residue)) {
  431. int len = p->iov.size - p->actual_length;
  432. if (len) {
  433. usb_packet_skip(p, len);
  434. if (len > s->data_len) {
  435. len = s->data_len;
  436. }
  437. s->data_len -= len;
  438. if (s->data_len == 0) {
  439. s->mode = USB_MSDM_CSW;
  440. }
  441. }
  442. }
  443. if (p->actual_length < p->iov.size) {
  444. DPRINTF("Deferring packet %p [wait data-out]\n", p);
  445. s->packet = p;
  446. p->status = USB_RET_ASYNC;
  447. }
  448. break;
  449. default:
  450. DPRINTF("Unexpected write (len %zd)\n", p->iov.size);
  451. goto fail;
  452. }
  453. break;
  454. case USB_TOKEN_IN:
  455. if (devep != 1)
  456. goto fail;
  457. switch (s->mode) {
  458. case USB_MSDM_DATAOUT:
  459. if (s->data_len != 0 || p->iov.size < 13) {
  460. goto fail;
  461. }
  462. /* Waiting for SCSI write to complete. */
  463. s->packet = p;
  464. p->status = USB_RET_ASYNC;
  465. break;
  466. case USB_MSDM_CSW:
  467. if (p->iov.size < 13) {
  468. goto fail;
  469. }
  470. if (s->req) {
  471. /* still in flight */
  472. DPRINTF("Deferring packet %p [wait status]\n", p);
  473. s->packet = p;
  474. p->status = USB_RET_ASYNC;
  475. } else {
  476. usb_msd_send_status(s, p);
  477. s->mode = USB_MSDM_CBW;
  478. }
  479. break;
  480. case USB_MSDM_DATAIN:
  481. DPRINTF("Data in %zd/%d, scsi_len %d\n",
  482. p->iov.size, s->data_len, s->scsi_len);
  483. if (s->scsi_len) {
  484. usb_msd_copy_data(s, p);
  485. }
  486. if (le32_to_cpu(s->csw.residue)) {
  487. int len = p->iov.size - p->actual_length;
  488. if (len) {
  489. usb_packet_skip(p, len);
  490. if (len > s->data_len) {
  491. len = s->data_len;
  492. }
  493. s->data_len -= len;
  494. if (s->data_len == 0) {
  495. s->mode = USB_MSDM_CSW;
  496. }
  497. }
  498. }
  499. if (p->actual_length < p->iov.size && s->mode == USB_MSDM_DATAIN) {
  500. DPRINTF("Deferring packet %p [wait data-in]\n", p);
  501. s->packet = p;
  502. p->status = USB_RET_ASYNC;
  503. }
  504. break;
  505. default:
  506. DPRINTF("Unexpected read (len %zd)\n", p->iov.size);
  507. goto fail;
  508. }
  509. break;
  510. default:
  511. DPRINTF("Bad token\n");
  512. fail:
  513. p->status = USB_RET_STALL;
  514. break;
  515. }
  516. }
  517. static void *usb_msd_load_request(QEMUFile *f, SCSIRequest *req)
  518. {
  519. MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
  520. /* nothing to load, just store req in our state struct */
  521. assert(s->req == NULL);
  522. scsi_req_ref(req);
  523. s->req = req;
  524. return NULL;
  525. }
  526. static const struct SCSIBusInfo usb_msd_scsi_info_storage = {
  527. .tcq = false,
  528. .max_target = 0,
  529. .max_lun = 0,
  530. .transfer_data = usb_msd_transfer_data,
  531. .complete = usb_msd_command_complete,
  532. .cancel = usb_msd_request_cancelled,
  533. .load_request = usb_msd_load_request,
  534. };
  535. static const struct SCSIBusInfo usb_msd_scsi_info_bot = {
  536. .tcq = false,
  537. .max_target = 0,
  538. .max_lun = 15,
  539. .transfer_data = usb_msd_transfer_data,
  540. .complete = usb_msd_command_complete,
  541. .cancel = usb_msd_request_cancelled,
  542. .load_request = usb_msd_load_request,
  543. };
  544. static void usb_msd_storage_realize(USBDevice *dev, Error **errp)
  545. {
  546. MSDState *s = USB_STORAGE_DEV(dev);
  547. BlockBackend *blk = s->conf.blk;
  548. SCSIDevice *scsi_dev;
  549. if (!blk) {
  550. error_setg(errp, "drive property not set");
  551. return;
  552. }
  553. if (!blkconf_blocksizes(&s->conf, errp)) {
  554. return;
  555. }
  556. if (!blkconf_apply_backend_options(&s->conf, blk_is_read_only(blk), true,
  557. errp)) {
  558. return;
  559. }
  560. /*
  561. * Hack alert: this pretends to be a block device, but it's really
  562. * a SCSI bus that can serve only a single device, which it
  563. * creates automatically. But first it needs to detach from its
  564. * blockdev, or else scsi_bus_legacy_add_drive() dies when it
  565. * attaches again. We also need to take another reference so that
  566. * blk_detach_dev() doesn't free blk while we still need it.
  567. *
  568. * The hack is probably a bad idea.
  569. */
  570. blk_ref(blk);
  571. blk_detach_dev(blk, DEVICE(s));
  572. s->conf.blk = NULL;
  573. usb_desc_create_serial(dev);
  574. usb_desc_init(dev);
  575. scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
  576. &usb_msd_scsi_info_storage, NULL);
  577. scsi_dev = scsi_bus_legacy_add_drive(&s->bus, blk, 0, !!s->removable,
  578. s->conf.bootindex, s->conf.share_rw,
  579. s->conf.rerror, s->conf.werror,
  580. dev->serial,
  581. errp);
  582. blk_unref(blk);
  583. if (!scsi_dev) {
  584. return;
  585. }
  586. usb_msd_handle_reset(dev);
  587. s->scsi_dev = scsi_dev;
  588. }
  589. static void usb_msd_bot_realize(USBDevice *dev, Error **errp)
  590. {
  591. MSDState *s = USB_STORAGE_DEV(dev);
  592. DeviceState *d = DEVICE(dev);
  593. usb_desc_create_serial(dev);
  594. usb_desc_init(dev);
  595. if (d->hotplugged) {
  596. s->dev.auto_attach = 0;
  597. }
  598. scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
  599. &usb_msd_scsi_info_bot, NULL);
  600. usb_msd_handle_reset(dev);
  601. }
  602. static const VMStateDescription vmstate_usb_msd = {
  603. .name = "usb-storage",
  604. .version_id = 1,
  605. .minimum_version_id = 1,
  606. .fields = (VMStateField[]) {
  607. VMSTATE_USB_DEVICE(dev, MSDState),
  608. VMSTATE_UINT32(mode, MSDState),
  609. VMSTATE_UINT32(scsi_len, MSDState),
  610. VMSTATE_UINT32(scsi_off, MSDState),
  611. VMSTATE_UINT32(data_len, MSDState),
  612. VMSTATE_UINT32(csw.sig, MSDState),
  613. VMSTATE_UINT32(csw.tag, MSDState),
  614. VMSTATE_UINT32(csw.residue, MSDState),
  615. VMSTATE_UINT8(csw.status, MSDState),
  616. VMSTATE_END_OF_LIST()
  617. }
  618. };
  619. static Property msd_properties[] = {
  620. DEFINE_BLOCK_PROPERTIES(MSDState, conf),
  621. DEFINE_BLOCK_ERROR_PROPERTIES(MSDState, conf),
  622. DEFINE_PROP_BIT("removable", MSDState, removable, 0, false),
  623. DEFINE_PROP_END_OF_LIST(),
  624. };
  625. static void usb_msd_class_initfn_common(ObjectClass *klass, void *data)
  626. {
  627. DeviceClass *dc = DEVICE_CLASS(klass);
  628. USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
  629. uc->product_desc = "QEMU USB MSD";
  630. uc->usb_desc = &desc;
  631. uc->cancel_packet = usb_msd_cancel_io;
  632. uc->handle_attach = usb_desc_attach;
  633. uc->handle_reset = usb_msd_handle_reset;
  634. uc->handle_control = usb_msd_handle_control;
  635. uc->handle_data = usb_msd_handle_data;
  636. set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
  637. dc->fw_name = "storage";
  638. dc->vmsd = &vmstate_usb_msd;
  639. }
  640. static void usb_msd_class_storage_initfn(ObjectClass *klass, void *data)
  641. {
  642. DeviceClass *dc = DEVICE_CLASS(klass);
  643. USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
  644. uc->realize = usb_msd_storage_realize;
  645. device_class_set_props(dc, msd_properties);
  646. }
  647. static void usb_msd_get_bootindex(Object *obj, Visitor *v, const char *name,
  648. void *opaque, Error **errp)
  649. {
  650. USBDevice *dev = USB_DEVICE(obj);
  651. MSDState *s = USB_STORAGE_DEV(dev);
  652. visit_type_int32(v, name, &s->conf.bootindex, errp);
  653. }
  654. static void usb_msd_set_bootindex(Object *obj, Visitor *v, const char *name,
  655. void *opaque, Error **errp)
  656. {
  657. USBDevice *dev = USB_DEVICE(obj);
  658. MSDState *s = USB_STORAGE_DEV(dev);
  659. int32_t boot_index;
  660. Error *local_err = NULL;
  661. if (!visit_type_int32(v, name, &boot_index, errp)) {
  662. return;
  663. }
  664. /* check whether bootindex is present in fw_boot_order list */
  665. check_boot_index(boot_index, &local_err);
  666. if (local_err) {
  667. goto out;
  668. }
  669. /* change bootindex to a new one */
  670. s->conf.bootindex = boot_index;
  671. if (s->scsi_dev) {
  672. object_property_set_int(OBJECT(s->scsi_dev), "bootindex", boot_index,
  673. &error_abort);
  674. }
  675. out:
  676. error_propagate(errp, local_err);
  677. }
  678. static const TypeInfo usb_storage_dev_type_info = {
  679. .name = TYPE_USB_STORAGE,
  680. .parent = TYPE_USB_DEVICE,
  681. .instance_size = sizeof(MSDState),
  682. .abstract = true,
  683. .class_init = usb_msd_class_initfn_common,
  684. };
  685. static void usb_msd_instance_init(Object *obj)
  686. {
  687. object_property_add(obj, "bootindex", "int32",
  688. usb_msd_get_bootindex,
  689. usb_msd_set_bootindex, NULL, NULL);
  690. object_property_set_int(obj, "bootindex", -1, NULL);
  691. }
  692. static void usb_msd_class_bot_initfn(ObjectClass *klass, void *data)
  693. {
  694. USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
  695. uc->realize = usb_msd_bot_realize;
  696. uc->attached_settable = true;
  697. }
  698. static const TypeInfo msd_info = {
  699. .name = "usb-storage",
  700. .parent = TYPE_USB_STORAGE,
  701. .class_init = usb_msd_class_storage_initfn,
  702. .instance_init = usb_msd_instance_init,
  703. };
  704. static const TypeInfo bot_info = {
  705. .name = "usb-bot",
  706. .parent = TYPE_USB_STORAGE,
  707. .class_init = usb_msd_class_bot_initfn,
  708. };
  709. static void usb_msd_register_types(void)
  710. {
  711. type_register_static(&usb_storage_dev_type_info);
  712. type_register_static(&msd_info);
  713. type_register_static(&bot_info);
  714. }
  715. type_init(usb_msd_register_types)