dev-storage.c 23 KB

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