usb-ccid.c 44 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397
  1. /*
  2. * Copyright (C) 2011 Red Hat, Inc.
  3. *
  4. * CCID Device emulation
  5. *
  6. * Written by Alon Levy, with contributions from Robert Relyea.
  7. *
  8. * Based on usb-serial.c, see it's copyright and attributions below.
  9. *
  10. * This work is licensed under the terms of the GNU GPL, version 2.1 or later.
  11. * See the COPYING file in the top-level directory.
  12. * ------- (original copyright & attribution for usb-serial.c below) --------
  13. * Copyright (c) 2006 CodeSourcery.
  14. * Copyright (c) 2008 Samuel Thibault <samuel.thibault@ens-lyon.org>
  15. * Written by Paul Brook, reused for FTDI by Samuel Thibault,
  16. */
  17. /*
  18. * References:
  19. *
  20. * CCID Specification Revision 1.1 April 22nd 2005
  21. * "Universal Serial Bus, Device Class: Smart Card"
  22. * Specification for Integrated Circuit(s) Cards Interface Devices
  23. *
  24. * Endianness note: from the spec (1.3)
  25. * "Fields that are larger than a byte are stored in little endian"
  26. *
  27. * KNOWN BUGS
  28. * 1. remove/insert can sometimes result in removed state instead of inserted.
  29. * This is a result of the following:
  30. * symptom: dmesg shows ERMOTEIO (-121), pcscd shows -99. This can happen
  31. * when a short packet is sent, as seen in uhci-usb.c, resulting from a urb
  32. * from the guest requesting SPD and us returning a smaller packet.
  33. * Not sure which messages trigger this.
  34. */
  35. #include "qemu-common.h"
  36. #include "qemu-error.h"
  37. #include "usb.h"
  38. #include "monitor.h"
  39. #include "hw/ccid.h"
  40. #define DPRINTF(s, lvl, fmt, ...) \
  41. do { \
  42. if (lvl <= s->debug) { \
  43. printf("usb-ccid: " fmt , ## __VA_ARGS__); \
  44. } \
  45. } while (0)
  46. #define D_WARN 1
  47. #define D_INFO 2
  48. #define D_MORE_INFO 3
  49. #define D_VERBOSE 4
  50. #define CCID_DEV_NAME "usb-ccid"
  51. /*
  52. * The two options for variable sized buffers:
  53. * make them constant size, for large enough constant,
  54. * or handle the migration complexity - VMState doesn't handle this case.
  55. * sizes are expected never to be exceeded, unless guest misbehaves.
  56. */
  57. #define BULK_OUT_DATA_SIZE 65536
  58. #define PENDING_ANSWERS_NUM 128
  59. #define BULK_IN_BUF_SIZE 384
  60. #define BULK_IN_PENDING_NUM 8
  61. #define InterfaceOutClass \
  62. ((USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE)<<8)
  63. #define InterfaceInClass \
  64. ((USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE)<<8)
  65. #define CCID_MAX_PACKET_SIZE 64
  66. #define CCID_CONTROL_ABORT 0x1
  67. #define CCID_CONTROL_GET_CLOCK_FREQUENCIES 0x2
  68. #define CCID_CONTROL_GET_DATA_RATES 0x3
  69. #define CCID_PRODUCT_DESCRIPTION "QEMU USB CCID"
  70. #define CCID_VENDOR_DESCRIPTION "QEMU " QEMU_VERSION
  71. #define CCID_INTERFACE_NAME "CCID Interface"
  72. #define CCID_SERIAL_NUMBER_STRING "1"
  73. /*
  74. * Using Gemplus Vendor and Product id
  75. * Effect on various drivers:
  76. * usbccid.sys (winxp, others untested) is a class driver so it doesn't care.
  77. * linux has a number of class drivers, but openct filters based on
  78. * vendor/product (/etc/openct.conf under fedora), hence Gemplus.
  79. */
  80. #define CCID_VENDOR_ID 0x08e6
  81. #define CCID_PRODUCT_ID 0x4433
  82. #define CCID_DEVICE_VERSION 0x0000
  83. /*
  84. * BULK_OUT messages from PC to Reader
  85. * Defined in CCID Rev 1.1 6.1 (page 26)
  86. */
  87. #define CCID_MESSAGE_TYPE_PC_to_RDR_IccPowerOn 0x62
  88. #define CCID_MESSAGE_TYPE_PC_to_RDR_IccPowerOff 0x63
  89. #define CCID_MESSAGE_TYPE_PC_to_RDR_GetSlotStatus 0x65
  90. #define CCID_MESSAGE_TYPE_PC_to_RDR_XfrBlock 0x6f
  91. #define CCID_MESSAGE_TYPE_PC_to_RDR_GetParameters 0x6c
  92. #define CCID_MESSAGE_TYPE_PC_to_RDR_ResetParameters 0x6d
  93. #define CCID_MESSAGE_TYPE_PC_to_RDR_SetParameters 0x61
  94. #define CCID_MESSAGE_TYPE_PC_to_RDR_Escape 0x6b
  95. #define CCID_MESSAGE_TYPE_PC_to_RDR_IccClock 0x6e
  96. #define CCID_MESSAGE_TYPE_PC_to_RDR_T0APDU 0x6a
  97. #define CCID_MESSAGE_TYPE_PC_to_RDR_Secure 0x69
  98. #define CCID_MESSAGE_TYPE_PC_to_RDR_Mechanical 0x71
  99. #define CCID_MESSAGE_TYPE_PC_to_RDR_Abort 0x72
  100. #define CCID_MESSAGE_TYPE_PC_to_RDR_SetDataRateAndClockFrequency 0x73
  101. /*
  102. * BULK_IN messages from Reader to PC
  103. * Defined in CCID Rev 1.1 6.2 (page 48)
  104. */
  105. #define CCID_MESSAGE_TYPE_RDR_to_PC_DataBlock 0x80
  106. #define CCID_MESSAGE_TYPE_RDR_to_PC_SlotStatus 0x81
  107. #define CCID_MESSAGE_TYPE_RDR_to_PC_Parameters 0x82
  108. #define CCID_MESSAGE_TYPE_RDR_to_PC_Escape 0x83
  109. #define CCID_MESSAGE_TYPE_RDR_to_PC_DataRateAndClockFrequency 0x84
  110. /*
  111. * INTERRUPT_IN messages from Reader to PC
  112. * Defined in CCID Rev 1.1 6.3 (page 56)
  113. */
  114. #define CCID_MESSAGE_TYPE_RDR_to_PC_NotifySlotChange 0x50
  115. #define CCID_MESSAGE_TYPE_RDR_to_PC_HardwareError 0x51
  116. /*
  117. * Endpoints for CCID - addresses are up to us to decide.
  118. * To support slot insertion and removal we must have an interrupt in ep
  119. * in addition we need a bulk in and bulk out ep
  120. * 5.2, page 20
  121. */
  122. #define CCID_INT_IN_EP 1
  123. #define CCID_BULK_IN_EP 2
  124. #define CCID_BULK_OUT_EP 3
  125. /* bmSlotICCState masks */
  126. #define SLOT_0_STATE_MASK 1
  127. #define SLOT_0_CHANGED_MASK 2
  128. /* Status codes that go in bStatus (see 6.2.6) */
  129. enum {
  130. ICC_STATUS_PRESENT_ACTIVE = 0,
  131. ICC_STATUS_PRESENT_INACTIVE,
  132. ICC_STATUS_NOT_PRESENT
  133. };
  134. enum {
  135. COMMAND_STATUS_NO_ERROR = 0,
  136. COMMAND_STATUS_FAILED,
  137. COMMAND_STATUS_TIME_EXTENSION_REQUIRED
  138. };
  139. /* Error codes that go in bError (see 6.2.6) */
  140. enum {
  141. ERROR_CMD_NOT_SUPPORTED = 0,
  142. ERROR_CMD_ABORTED = -1,
  143. ERROR_ICC_MUTE = -2,
  144. ERROR_XFR_PARITY_ERROR = -3,
  145. ERROR_XFR_OVERRUN = -4,
  146. ERROR_HW_ERROR = -5,
  147. };
  148. /* 6.2.6 RDR_to_PC_SlotStatus definitions */
  149. enum {
  150. CLOCK_STATUS_RUNNING = 0,
  151. /*
  152. * 0 - Clock Running, 1 - Clock stopped in State L, 2 - H,
  153. * 3 - unknown state. rest are RFU
  154. */
  155. };
  156. typedef struct __attribute__ ((__packed__)) CCID_Header {
  157. uint8_t bMessageType;
  158. uint32_t dwLength;
  159. uint8_t bSlot;
  160. uint8_t bSeq;
  161. } CCID_Header;
  162. typedef struct __attribute__ ((__packed__)) CCID_BULK_IN {
  163. CCID_Header hdr;
  164. uint8_t bStatus; /* Only used in BULK_IN */
  165. uint8_t bError; /* Only used in BULK_IN */
  166. } CCID_BULK_IN;
  167. typedef struct __attribute__ ((__packed__)) CCID_SlotStatus {
  168. CCID_BULK_IN b;
  169. uint8_t bClockStatus;
  170. } CCID_SlotStatus;
  171. typedef struct __attribute__ ((__packed__)) CCID_Parameter {
  172. CCID_BULK_IN b;
  173. uint8_t bProtocolNum;
  174. uint8_t abProtocolDataStructure[0];
  175. } CCID_Parameter;
  176. typedef struct __attribute__ ((__packed__)) CCID_DataBlock {
  177. CCID_BULK_IN b;
  178. uint8_t bChainParameter;
  179. uint8_t abData[0];
  180. } CCID_DataBlock;
  181. /* 6.1.4 PC_to_RDR_XfrBlock */
  182. typedef struct __attribute__ ((__packed__)) CCID_XferBlock {
  183. CCID_Header hdr;
  184. uint8_t bBWI; /* Block Waiting Timeout */
  185. uint16_t wLevelParameter; /* XXX currently unused */
  186. uint8_t abData[0];
  187. } CCID_XferBlock;
  188. typedef struct __attribute__ ((__packed__)) CCID_IccPowerOn {
  189. CCID_Header hdr;
  190. uint8_t bPowerSelect;
  191. uint16_t abRFU;
  192. } CCID_IccPowerOn;
  193. typedef struct __attribute__ ((__packed__)) CCID_IccPowerOff {
  194. CCID_Header hdr;
  195. uint16_t abRFU;
  196. } CCID_IccPowerOff;
  197. typedef struct __attribute__ ((__packed__)) CCID_SetParameters {
  198. CCID_Header hdr;
  199. uint8_t bProtocolNum;
  200. uint16_t abRFU;
  201. uint8_t abProtocolDataStructure[0];
  202. } CCID_SetParameters;
  203. typedef struct CCID_Notify_Slot_Change {
  204. uint8_t bMessageType; /* CCID_MESSAGE_TYPE_RDR_to_PC_NotifySlotChange */
  205. uint8_t bmSlotICCState;
  206. } CCID_Notify_Slot_Change;
  207. /* used for DataBlock response to XferBlock */
  208. typedef struct Answer {
  209. uint8_t slot;
  210. uint8_t seq;
  211. } Answer;
  212. /* pending BULK_IN messages */
  213. typedef struct BulkIn {
  214. uint8_t data[BULK_IN_BUF_SIZE];
  215. uint32_t len;
  216. uint32_t pos;
  217. } BulkIn;
  218. enum {
  219. MIGRATION_NONE,
  220. MIGRATION_MIGRATED,
  221. };
  222. typedef struct CCIDBus {
  223. BusState qbus;
  224. } CCIDBus;
  225. #define MAX_PROTOCOL_SIZE 7
  226. /*
  227. * powered - defaults to true, changed by PowerOn/PowerOff messages
  228. */
  229. typedef struct USBCCIDState {
  230. USBDevice dev;
  231. CCIDBus bus;
  232. CCIDCardState *card;
  233. CCIDCardInfo *cardinfo; /* caching the info pointer */
  234. BulkIn bulk_in_pending[BULK_IN_PENDING_NUM]; /* circular */
  235. uint32_t bulk_in_pending_start;
  236. uint32_t bulk_in_pending_end; /* first free */
  237. uint32_t bulk_in_pending_num;
  238. BulkIn *current_bulk_in;
  239. uint8_t bulk_out_data[BULK_OUT_DATA_SIZE];
  240. uint32_t bulk_out_pos;
  241. uint64_t last_answer_error;
  242. Answer pending_answers[PENDING_ANSWERS_NUM];
  243. uint32_t pending_answers_start;
  244. uint32_t pending_answers_end;
  245. uint32_t pending_answers_num;
  246. uint8_t bError;
  247. uint8_t bmCommandStatus;
  248. uint8_t bProtocolNum;
  249. uint8_t abProtocolDataStructure[MAX_PROTOCOL_SIZE];
  250. uint32_t ulProtocolDataStructureSize;
  251. uint32_t state_vmstate;
  252. uint32_t migration_target_ip;
  253. uint16_t migration_target_port;
  254. uint8_t migration_state;
  255. uint8_t bmSlotICCState;
  256. uint8_t powered;
  257. uint8_t notify_slot_change;
  258. uint8_t debug;
  259. } USBCCIDState;
  260. /*
  261. * CCID Spec chapter 4: CCID uses a standard device descriptor per Chapter 9,
  262. * "USB Device Framework", section 9.6.1, in the Universal Serial Bus
  263. * Specification.
  264. *
  265. * This device implemented based on the spec and with an Athena Smart Card
  266. * Reader as reference:
  267. * 0dc3:1004 Athena Smartcard Solutions, Inc.
  268. */
  269. static const uint8_t qemu_ccid_dev_descriptor[] = {
  270. 0x12, /* u8 bLength; */
  271. USB_DT_DEVICE, /* u8 bDescriptorType; Device */
  272. 0x10, 0x01, /* u16 bcdUSB; v1.1 */
  273. 0x00, /* u8 bDeviceClass; */
  274. 0x00, /* u8 bDeviceSubClass; */
  275. 0x00, /* u8 bDeviceProtocol; [ low/full speeds only ] */
  276. 0x40, /* u8 bMaxPacketSize0; 8 Bytes (valid: 8,16,32,64) */
  277. /* Vendor and product id are arbitrary. */
  278. /* u16 idVendor */
  279. CCID_VENDOR_ID & 0xff, CCID_VENDOR_ID >> 8,
  280. /* u16 idProduct */
  281. CCID_PRODUCT_ID & 0xff, CCID_PRODUCT_ID >> 8,
  282. /* u16 bcdDevice */
  283. CCID_DEVICE_VERSION & 0xff, CCID_DEVICE_VERSION >> 8,
  284. 0x01, /* u8 iManufacturer; */
  285. 0x02, /* u8 iProduct; */
  286. 0x03, /* u8 iSerialNumber; */
  287. 0x01, /* u8 bNumConfigurations; */
  288. };
  289. static const uint8_t qemu_ccid_config_descriptor[] = {
  290. /* one configuration */
  291. 0x09, /* u8 bLength; */
  292. USB_DT_CONFIG, /* u8 bDescriptorType; Configuration */
  293. 0x5d, 0x00, /* u16 wTotalLength; 9+9+54+7+7+7 */
  294. 0x01, /* u8 bNumInterfaces; (1) */
  295. 0x01, /* u8 bConfigurationValue; */
  296. 0x00, /* u8 iConfiguration; */
  297. 0xe0, /* u8 bmAttributes;
  298. Bit 7: must be set,
  299. 6: Self-powered,
  300. 5: Remote wakeup,
  301. 4..0: resvd */
  302. 100/2, /* u8 MaxPower; 50 == 100mA */
  303. /* one interface */
  304. 0x09, /* u8 if_bLength; */
  305. USB_DT_INTERFACE, /* u8 if_bDescriptorType; Interface */
  306. 0x00, /* u8 if_bInterfaceNumber; */
  307. 0x00, /* u8 if_bAlternateSetting; */
  308. 0x03, /* u8 if_bNumEndpoints; */
  309. 0x0b, /* u8 if_bInterfaceClass; Smart Card Device Class */
  310. 0x00, /* u8 if_bInterfaceSubClass; Subclass code */
  311. 0x00, /* u8 if_bInterfaceProtocol; Protocol code */
  312. 0x04, /* u8 if_iInterface; Index of string descriptor */
  313. /* Smart Card Device Class Descriptor */
  314. 0x36, /* u8 bLength; */
  315. 0x21, /* u8 bDescriptorType; Functional */
  316. 0x10, 0x01, /* u16 bcdCCID; CCID Specification Release Number. */
  317. 0x00, /*
  318. * u8 bMaxSlotIndex; The index of the highest available
  319. * slot on this device. All slots are consecutive starting
  320. * at 00h.
  321. */
  322. 0x07, /* u8 bVoltageSupport; 01h - 5.0v, 02h - 3.0, 03 - 1.8 */
  323. 0x03, 0x00, /* u32 dwProtocols; RRRR PPPP. RRRR = 0000h.*/
  324. 0x00, 0x00, /* PPPP: 0001h = Protocol T=0, 0002h = Protocol T=1 */
  325. /* u32 dwDefaultClock; in kHZ (0x0fa0 is 4 MHz) */
  326. 0xa0, 0x0f, 0x00, 0x00,
  327. /* u32 dwMaximumClock; */
  328. 0x00, 0x00, 0x01, 0x00,
  329. 0x00, /* u8 bNumClockSupported; *
  330. * 0 means just the default and max. */
  331. /* u32 dwDataRate ;bps. 9600 == 00002580h */
  332. 0x80, 0x25, 0x00, 0x00,
  333. /* u32 dwMaxDataRate ; 11520 bps == 0001C200h */
  334. 0x00, 0xC2, 0x01, 0x00,
  335. 0x00, /* u8 bNumDataRatesSupported; 00 means all rates between
  336. * default and max */
  337. /* u32 dwMaxIFSD; *
  338. * maximum IFSD supported by CCID for protocol *
  339. * T=1 (Maximum seen from various cards) */
  340. 0xfe, 0x00, 0x00, 0x00,
  341. /* u32 dwSyncProtocols; 1 - 2-wire, 2 - 3-wire, 4 - I2C */
  342. 0x00, 0x00, 0x00, 0x00,
  343. /* u32 dwMechanical; 0 - no special characteristics. */
  344. 0x00, 0x00, 0x00, 0x00,
  345. /*
  346. * u32 dwFeatures;
  347. * 0 - No special characteristics
  348. * + 2 Automatic parameter configuration based on ATR data
  349. * + 4 Automatic activation of ICC on inserting
  350. * + 8 Automatic ICC voltage selection
  351. * + 10 Automatic ICC clock frequency change
  352. * + 20 Automatic baud rate change
  353. * + 40 Automatic parameters negotiation made by the CCID
  354. * + 80 automatic PPS made by the CCID
  355. * 100 CCID can set ICC in clock stop mode
  356. * 200 NAD value other then 00 accepted (T=1 protocol)
  357. * + 400 Automatic IFSD exchange as first exchange (T=1)
  358. * One of the following only:
  359. * + 10000 TPDU level exchanges with CCID
  360. * 20000 Short APDU level exchange with CCID
  361. * 40000 Short and Extended APDU level exchange with CCID
  362. *
  363. * + 100000 USB Wake up signaling supported on card
  364. * insertion and removal. Must set bit 5 in bmAttributes
  365. * in Configuration descriptor if 100000 is set.
  366. */
  367. 0xfe, 0x04, 0x11, 0x00,
  368. /*
  369. * u32 dwMaxCCIDMessageLength; For extended APDU in
  370. * [261 + 10 , 65544 + 10]. Otherwise the minimum is
  371. * wMaxPacketSize of the Bulk-OUT endpoint
  372. */
  373. 0x12, 0x00, 0x01, 0x00,
  374. 0xFF, /*
  375. * u8 bClassGetResponse; Significant only for CCID that
  376. * offers an APDU level for exchanges. Indicates the
  377. * default class value used by the CCID when it sends a
  378. * Get Response command to perform the transportation of
  379. * an APDU by T=0 protocol
  380. * FFh indicates that the CCID echos the class of the APDU.
  381. */
  382. 0xFF, /*
  383. * u8 bClassEnvelope; EAPDU only. Envelope command for
  384. * T=0
  385. */
  386. 0x00, 0x00, /*
  387. * u16 wLcdLayout; XXYY Number of lines (XX) and chars per
  388. * line for LCD display used for PIN entry. 0000 - no LCD
  389. */
  390. 0x01, /*
  391. * u8 bPINSupport; 01h PIN Verification,
  392. * 02h PIN Modification
  393. */
  394. 0x01, /* u8 bMaxCCIDBusySlots; */
  395. /* Interrupt-IN endpoint */
  396. 0x07, /* u8 ep_bLength; */
  397. /* u8 ep_bDescriptorType; Endpoint */
  398. USB_DT_ENDPOINT,
  399. /* u8 ep_bEndpointAddress; IN Endpoint 1 */
  400. 0x80 | CCID_INT_IN_EP,
  401. 0x03, /* u8 ep_bmAttributes; Interrupt */
  402. /* u16 ep_wMaxPacketSize; */
  403. CCID_MAX_PACKET_SIZE & 0xff, (CCID_MAX_PACKET_SIZE >> 8),
  404. 0xff, /* u8 ep_bInterval; */
  405. /* Bulk-In endpoint */
  406. 0x07, /* u8 ep_bLength; */
  407. /* u8 ep_bDescriptorType; Endpoint */
  408. USB_DT_ENDPOINT,
  409. /* u8 ep_bEndpointAddress; IN Endpoint 2 */
  410. 0x80 | CCID_BULK_IN_EP,
  411. 0x02, /* u8 ep_bmAttributes; Bulk */
  412. 0x40, 0x00, /* u16 ep_wMaxPacketSize; */
  413. 0x00, /* u8 ep_bInterval; */
  414. /* Bulk-Out endpoint */
  415. 0x07, /* u8 ep_bLength; */
  416. /* u8 ep_bDescriptorType; Endpoint */
  417. USB_DT_ENDPOINT,
  418. /* u8 ep_bEndpointAddress; OUT Endpoint 3 */
  419. CCID_BULK_OUT_EP,
  420. 0x02, /* u8 ep_bmAttributes; Bulk */
  421. 0x40, 0x00, /* u16 ep_wMaxPacketSize; */
  422. 0x00, /* u8 ep_bInterval; */
  423. };
  424. static bool ccid_has_pending_answers(USBCCIDState *s)
  425. {
  426. return s->pending_answers_num > 0;
  427. }
  428. static void ccid_clear_pending_answers(USBCCIDState *s)
  429. {
  430. s->pending_answers_num = 0;
  431. s->pending_answers_start = 0;
  432. s->pending_answers_end = 0;
  433. }
  434. static void ccid_print_pending_answers(USBCCIDState *s)
  435. {
  436. Answer *answer;
  437. int i, count;
  438. DPRINTF(s, D_VERBOSE, "usb-ccid: pending answers:");
  439. if (!ccid_has_pending_answers(s)) {
  440. DPRINTF(s, D_VERBOSE, " empty\n");
  441. return;
  442. }
  443. for (i = s->pending_answers_start, count = s->pending_answers_num ;
  444. count > 0; count--, i++) {
  445. answer = &s->pending_answers[i % PENDING_ANSWERS_NUM];
  446. if (count == 1) {
  447. DPRINTF(s, D_VERBOSE, "%d:%d\n", answer->slot, answer->seq);
  448. } else {
  449. DPRINTF(s, D_VERBOSE, "%d:%d,", answer->slot, answer->seq);
  450. }
  451. }
  452. }
  453. static void ccid_add_pending_answer(USBCCIDState *s, CCID_Header *hdr)
  454. {
  455. Answer *answer;
  456. assert(s->pending_answers_num < PENDING_ANSWERS_NUM);
  457. s->pending_answers_num++;
  458. answer =
  459. &s->pending_answers[(s->pending_answers_end++) % PENDING_ANSWERS_NUM];
  460. answer->slot = hdr->bSlot;
  461. answer->seq = hdr->bSeq;
  462. ccid_print_pending_answers(s);
  463. }
  464. static void ccid_remove_pending_answer(USBCCIDState *s,
  465. uint8_t *slot, uint8_t *seq)
  466. {
  467. Answer *answer;
  468. assert(s->pending_answers_num > 0);
  469. s->pending_answers_num--;
  470. answer =
  471. &s->pending_answers[(s->pending_answers_start++) % PENDING_ANSWERS_NUM];
  472. *slot = answer->slot;
  473. *seq = answer->seq;
  474. ccid_print_pending_answers(s);
  475. }
  476. static void ccid_bulk_in_clear(USBCCIDState *s)
  477. {
  478. s->bulk_in_pending_start = 0;
  479. s->bulk_in_pending_end = 0;
  480. s->bulk_in_pending_num = 0;
  481. }
  482. static void ccid_bulk_in_release(USBCCIDState *s)
  483. {
  484. assert(s->current_bulk_in != NULL);
  485. s->current_bulk_in->pos = 0;
  486. s->current_bulk_in = NULL;
  487. }
  488. static void ccid_bulk_in_get(USBCCIDState *s)
  489. {
  490. if (s->current_bulk_in != NULL || s->bulk_in_pending_num == 0) {
  491. return;
  492. }
  493. assert(s->bulk_in_pending_num > 0);
  494. s->bulk_in_pending_num--;
  495. s->current_bulk_in =
  496. &s->bulk_in_pending[(s->bulk_in_pending_start++) % BULK_IN_PENDING_NUM];
  497. }
  498. static void *ccid_reserve_recv_buf(USBCCIDState *s, uint16_t len)
  499. {
  500. BulkIn *bulk_in;
  501. DPRINTF(s, D_VERBOSE, "%s: QUEUE: reserve %d bytes\n", __func__, len);
  502. /* look for an existing element */
  503. if (len > BULK_IN_BUF_SIZE) {
  504. DPRINTF(s, D_WARN, "usb-ccid.c: %s: len larger then max (%d>%d). "
  505. "discarding message.\n",
  506. __func__, len, BULK_IN_BUF_SIZE);
  507. return NULL;
  508. }
  509. if (s->bulk_in_pending_num >= BULK_IN_PENDING_NUM) {
  510. DPRINTF(s, D_WARN, "usb-ccid.c: %s: No free bulk_in buffers. "
  511. "discarding message.\n", __func__);
  512. return NULL;
  513. }
  514. bulk_in =
  515. &s->bulk_in_pending[(s->bulk_in_pending_end++) % BULK_IN_PENDING_NUM];
  516. s->bulk_in_pending_num++;
  517. bulk_in->len = len;
  518. return bulk_in->data;
  519. }
  520. static void ccid_reset(USBCCIDState *s)
  521. {
  522. ccid_bulk_in_clear(s);
  523. ccid_clear_pending_answers(s);
  524. }
  525. static void ccid_detach(USBCCIDState *s)
  526. {
  527. ccid_reset(s);
  528. }
  529. static void ccid_handle_reset(USBDevice *dev)
  530. {
  531. USBCCIDState *s = DO_UPCAST(USBCCIDState, dev, dev);
  532. DPRINTF(s, 1, "Reset\n");
  533. ccid_reset(s);
  534. }
  535. static int ccid_handle_control(USBDevice *dev, USBPacket *p, int request,
  536. int value, int index, int length, uint8_t *data)
  537. {
  538. USBCCIDState *s = DO_UPCAST(USBCCIDState, dev, dev);
  539. int ret = 0;
  540. DPRINTF(s, 1, "got control %x, value %x\n", request, value);
  541. switch (request) {
  542. case DeviceRequest | USB_REQ_GET_STATUS:
  543. data[0] = (1 << USB_DEVICE_SELF_POWERED) |
  544. (dev->remote_wakeup << USB_DEVICE_REMOTE_WAKEUP);
  545. data[1] = 0x00;
  546. ret = 2;
  547. break;
  548. case DeviceOutRequest | USB_REQ_CLEAR_FEATURE:
  549. if (value == USB_DEVICE_REMOTE_WAKEUP) {
  550. dev->remote_wakeup = 0;
  551. } else {
  552. goto fail;
  553. }
  554. ret = 0;
  555. break;
  556. case DeviceOutRequest | USB_REQ_SET_FEATURE:
  557. if (value == USB_DEVICE_REMOTE_WAKEUP) {
  558. dev->remote_wakeup = 1;
  559. } else {
  560. goto fail;
  561. }
  562. ret = 0;
  563. break;
  564. case DeviceOutRequest | USB_REQ_SET_ADDRESS:
  565. dev->addr = value;
  566. ret = 0;
  567. break;
  568. case DeviceRequest | USB_REQ_GET_DESCRIPTOR:
  569. switch (value >> 8) {
  570. case USB_DT_DEVICE:
  571. memcpy(data, qemu_ccid_dev_descriptor,
  572. sizeof(qemu_ccid_dev_descriptor));
  573. ret = sizeof(qemu_ccid_dev_descriptor);
  574. break;
  575. case USB_DT_CONFIG:
  576. memcpy(data, qemu_ccid_config_descriptor,
  577. sizeof(qemu_ccid_config_descriptor));
  578. ret = sizeof(qemu_ccid_config_descriptor);
  579. break;
  580. case USB_DT_STRING:
  581. switch (value & 0xff) {
  582. case 0:
  583. /* language ids */
  584. data[0] = 4;
  585. data[1] = 3;
  586. data[2] = 0x09;
  587. data[3] = 0x04;
  588. ret = 4;
  589. break;
  590. case 1:
  591. /* vendor description */
  592. ret = set_usb_string(data, CCID_VENDOR_DESCRIPTION);
  593. break;
  594. case 2:
  595. /* product description */
  596. ret = set_usb_string(data, CCID_PRODUCT_DESCRIPTION);
  597. break;
  598. case 3:
  599. /* serial number */
  600. ret = set_usb_string(data, CCID_SERIAL_NUMBER_STRING);
  601. break;
  602. case 4:
  603. /* interface name */
  604. ret = set_usb_string(data, CCID_INTERFACE_NAME);
  605. break;
  606. default:
  607. goto fail;
  608. }
  609. break;
  610. default:
  611. goto fail;
  612. }
  613. break;
  614. case DeviceRequest | USB_REQ_GET_CONFIGURATION:
  615. data[0] = 1;
  616. ret = 1;
  617. break;
  618. case DeviceOutRequest | USB_REQ_SET_CONFIGURATION:
  619. /* Only one configuration - we just ignore the request */
  620. ret = 0;
  621. break;
  622. case DeviceRequest | USB_REQ_GET_INTERFACE:
  623. data[0] = 0;
  624. ret = 1;
  625. break;
  626. case InterfaceOutRequest | USB_REQ_SET_INTERFACE:
  627. ret = 0;
  628. break;
  629. case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
  630. ret = 0;
  631. break;
  632. /* Class specific requests. */
  633. case InterfaceOutClass | CCID_CONTROL_ABORT:
  634. DPRINTF(s, 1, "ccid_control abort UNIMPLEMENTED\n");
  635. ret = USB_RET_STALL;
  636. break;
  637. case InterfaceInClass | CCID_CONTROL_GET_CLOCK_FREQUENCIES:
  638. DPRINTF(s, 1, "ccid_control get clock frequencies UNIMPLEMENTED\n");
  639. ret = USB_RET_STALL;
  640. break;
  641. case InterfaceInClass | CCID_CONTROL_GET_DATA_RATES:
  642. DPRINTF(s, 1, "ccid_control get data rates UNIMPLEMENTED\n");
  643. ret = USB_RET_STALL;
  644. break;
  645. default:
  646. fail:
  647. DPRINTF(s, 1, "got unsupported/bogus control %x, value %x\n",
  648. request, value);
  649. ret = USB_RET_STALL;
  650. break;
  651. }
  652. return ret;
  653. }
  654. static bool ccid_card_inserted(USBCCIDState *s)
  655. {
  656. return s->bmSlotICCState & SLOT_0_STATE_MASK;
  657. }
  658. static uint8_t ccid_card_status(USBCCIDState *s)
  659. {
  660. return ccid_card_inserted(s)
  661. ? (s->powered ?
  662. ICC_STATUS_PRESENT_ACTIVE
  663. : ICC_STATUS_PRESENT_INACTIVE
  664. )
  665. : ICC_STATUS_NOT_PRESENT;
  666. }
  667. static uint8_t ccid_calc_status(USBCCIDState *s)
  668. {
  669. /*
  670. * page 55, 6.2.6, calculation of bStatus from bmICCStatus and
  671. * bmCommandStatus
  672. */
  673. uint8_t ret = ccid_card_status(s) | (s->bmCommandStatus << 6);
  674. DPRINTF(s, D_VERBOSE, "status = %d\n", ret);
  675. return ret;
  676. }
  677. static void ccid_reset_error_status(USBCCIDState *s)
  678. {
  679. s->bError = ERROR_CMD_NOT_SUPPORTED;
  680. s->bmCommandStatus = COMMAND_STATUS_NO_ERROR;
  681. }
  682. static void ccid_write_slot_status(USBCCIDState *s, CCID_Header *recv)
  683. {
  684. CCID_SlotStatus *h = ccid_reserve_recv_buf(s, sizeof(CCID_SlotStatus));
  685. if (h == NULL) {
  686. return;
  687. }
  688. h->b.hdr.bMessageType = CCID_MESSAGE_TYPE_RDR_to_PC_SlotStatus;
  689. h->b.hdr.dwLength = 0;
  690. h->b.hdr.bSlot = recv->bSlot;
  691. h->b.hdr.bSeq = recv->bSeq;
  692. h->b.bStatus = ccid_calc_status(s);
  693. h->b.bError = s->bError;
  694. h->bClockStatus = CLOCK_STATUS_RUNNING;
  695. ccid_reset_error_status(s);
  696. }
  697. static void ccid_write_parameters(USBCCIDState *s, CCID_Header *recv)
  698. {
  699. CCID_Parameter *h;
  700. uint32_t len = s->ulProtocolDataStructureSize;
  701. h = ccid_reserve_recv_buf(s, sizeof(CCID_Parameter) + len);
  702. if (h == NULL) {
  703. return;
  704. }
  705. h->b.hdr.bMessageType = CCID_MESSAGE_TYPE_RDR_to_PC_Parameters;
  706. h->b.hdr.dwLength = 0;
  707. h->b.hdr.bSlot = recv->bSlot;
  708. h->b.hdr.bSeq = recv->bSeq;
  709. h->b.bStatus = ccid_calc_status(s);
  710. h->b.bError = s->bError;
  711. h->bProtocolNum = s->bProtocolNum;
  712. memcpy(h->abProtocolDataStructure, s->abProtocolDataStructure, len);
  713. ccid_reset_error_status(s);
  714. }
  715. static void ccid_write_data_block(USBCCIDState *s, uint8_t slot, uint8_t seq,
  716. const uint8_t *data, uint32_t len)
  717. {
  718. CCID_DataBlock *p = ccid_reserve_recv_buf(s, sizeof(*p) + len);
  719. if (p == NULL) {
  720. return;
  721. }
  722. p->b.hdr.bMessageType = CCID_MESSAGE_TYPE_RDR_to_PC_DataBlock;
  723. p->b.hdr.dwLength = cpu_to_le32(len);
  724. p->b.hdr.bSlot = slot;
  725. p->b.hdr.bSeq = seq;
  726. p->b.bStatus = ccid_calc_status(s);
  727. p->b.bError = s->bError;
  728. if (p->b.bError) {
  729. DPRINTF(s, D_VERBOSE, "error %d", p->b.bError);
  730. }
  731. memcpy(p->abData, data, len);
  732. ccid_reset_error_status(s);
  733. }
  734. static void ccid_write_data_block_answer(USBCCIDState *s,
  735. const uint8_t *data, uint32_t len)
  736. {
  737. uint8_t seq;
  738. uint8_t slot;
  739. if (!ccid_has_pending_answers(s)) {
  740. abort();
  741. }
  742. ccid_remove_pending_answer(s, &slot, &seq);
  743. ccid_write_data_block(s, slot, seq, data, len);
  744. }
  745. static void ccid_write_data_block_atr(USBCCIDState *s, CCID_Header *recv)
  746. {
  747. const uint8_t *atr = NULL;
  748. uint32_t len = 0;
  749. if (s->card) {
  750. atr = s->cardinfo->get_atr(s->card, &len);
  751. }
  752. ccid_write_data_block(s, recv->bSlot, recv->bSeq, atr, len);
  753. }
  754. static void ccid_set_parameters(USBCCIDState *s, CCID_Header *recv)
  755. {
  756. CCID_SetParameters *ph = (CCID_SetParameters *) recv;
  757. uint32_t len = 0;
  758. if ((ph->bProtocolNum & 3) == 0) {
  759. len = 5;
  760. }
  761. if ((ph->bProtocolNum & 3) == 1) {
  762. len = 7;
  763. }
  764. if (len == 0) {
  765. s->bmCommandStatus = COMMAND_STATUS_FAILED;
  766. s->bError = 7; /* Protocol invalid or not supported */
  767. return;
  768. }
  769. s->bProtocolNum = ph->bProtocolNum;
  770. memcpy(s->abProtocolDataStructure, ph->abProtocolDataStructure, len);
  771. s->ulProtocolDataStructureSize = len;
  772. DPRINTF(s, 1, "%s: using len %d\n", __func__, len);
  773. }
  774. /*
  775. * must be 5 bytes for T=0, 7 bytes for T=1
  776. * See page 52
  777. */
  778. static const uint8_t abDefaultProtocolDataStructure[7] = {
  779. 0x77, 0x00, 0x00, 0x00, 0x00, 0xfe /*IFSC*/, 0x00 /*NAD*/ };
  780. static void ccid_reset_parameters(USBCCIDState *s)
  781. {
  782. uint32_t len = sizeof(abDefaultProtocolDataStructure);
  783. s->bProtocolNum = 1; /* T=1 */
  784. s->ulProtocolDataStructureSize = len;
  785. memcpy(s->abProtocolDataStructure, abDefaultProtocolDataStructure, len);
  786. }
  787. static void ccid_report_error_failed(USBCCIDState *s, uint8_t error)
  788. {
  789. s->bmCommandStatus = COMMAND_STATUS_FAILED;
  790. s->bError = error;
  791. }
  792. /* NOTE: only a single slot is supported (SLOT_0) */
  793. static void ccid_on_slot_change(USBCCIDState *s, bool full)
  794. {
  795. /* RDR_to_PC_NotifySlotChange, 6.3.1 page 56 */
  796. uint8_t current = s->bmSlotICCState;
  797. if (full) {
  798. s->bmSlotICCState |= SLOT_0_STATE_MASK;
  799. } else {
  800. s->bmSlotICCState &= ~SLOT_0_STATE_MASK;
  801. }
  802. if (current != s->bmSlotICCState) {
  803. s->bmSlotICCState |= SLOT_0_CHANGED_MASK;
  804. }
  805. s->notify_slot_change = true;
  806. }
  807. static void ccid_write_data_block_error(
  808. USBCCIDState *s, uint8_t slot, uint8_t seq)
  809. {
  810. ccid_write_data_block(s, slot, seq, NULL, 0);
  811. }
  812. static void ccid_on_apdu_from_guest(USBCCIDState *s, CCID_XferBlock *recv)
  813. {
  814. uint32_t len;
  815. if (ccid_card_status(s) != ICC_STATUS_PRESENT_ACTIVE) {
  816. DPRINTF(s, 1,
  817. "usb-ccid: not sending apdu to client, no card connected\n");
  818. ccid_write_data_block_error(s, recv->hdr.bSlot, recv->hdr.bSeq);
  819. return;
  820. }
  821. len = le32_to_cpu(recv->hdr.dwLength);
  822. DPRINTF(s, 1, "%s: seq %d, len %d\n", __func__,
  823. recv->hdr.bSeq, len);
  824. ccid_add_pending_answer(s, (CCID_Header *)recv);
  825. if (s->card) {
  826. s->cardinfo->apdu_from_guest(s->card, recv->abData, len);
  827. } else {
  828. DPRINTF(s, D_WARN, "warning: discarded apdu\n");
  829. }
  830. }
  831. /*
  832. * Handle a single USB_TOKEN_OUT, return value returned to guest.
  833. * Return value:
  834. * 0 - all ok
  835. * USB_RET_STALL - failed to handle packet
  836. */
  837. static int ccid_handle_bulk_out(USBCCIDState *s, USBPacket *p)
  838. {
  839. CCID_Header *ccid_header;
  840. if (p->len + s->bulk_out_pos > BULK_OUT_DATA_SIZE) {
  841. return USB_RET_STALL;
  842. }
  843. ccid_header = (CCID_Header *)s->bulk_out_data;
  844. memcpy(s->bulk_out_data + s->bulk_out_pos, p->data, p->len);
  845. s->bulk_out_pos += p->len;
  846. if (p->len == CCID_MAX_PACKET_SIZE) {
  847. DPRINTF(s, D_VERBOSE,
  848. "usb-ccid: bulk_in: expecting more packets (%d/%d)\n",
  849. p->len, ccid_header->dwLength);
  850. return 0;
  851. }
  852. if (s->bulk_out_pos < 10) {
  853. DPRINTF(s, 1,
  854. "%s: bad USB_TOKEN_OUT length, should be at least 10 bytes\n",
  855. __func__);
  856. } else {
  857. DPRINTF(s, D_MORE_INFO, "%s %x\n", __func__, ccid_header->bMessageType);
  858. switch (ccid_header->bMessageType) {
  859. case CCID_MESSAGE_TYPE_PC_to_RDR_GetSlotStatus:
  860. ccid_write_slot_status(s, ccid_header);
  861. break;
  862. case CCID_MESSAGE_TYPE_PC_to_RDR_IccPowerOn:
  863. DPRINTF(s, 1, "PowerOn: %d\n",
  864. ((CCID_IccPowerOn *)(ccid_header))->bPowerSelect);
  865. s->powered = true;
  866. if (!ccid_card_inserted(s)) {
  867. ccid_report_error_failed(s, ERROR_ICC_MUTE);
  868. }
  869. /* atr is written regardless of error. */
  870. ccid_write_data_block_atr(s, ccid_header);
  871. break;
  872. case CCID_MESSAGE_TYPE_PC_to_RDR_IccPowerOff:
  873. DPRINTF(s, 1, "PowerOff\n");
  874. ccid_reset_error_status(s);
  875. s->powered = false;
  876. ccid_write_slot_status(s, ccid_header);
  877. break;
  878. case CCID_MESSAGE_TYPE_PC_to_RDR_XfrBlock:
  879. ccid_on_apdu_from_guest(s, (CCID_XferBlock *)s->bulk_out_data);
  880. break;
  881. case CCID_MESSAGE_TYPE_PC_to_RDR_SetParameters:
  882. ccid_reset_error_status(s);
  883. ccid_set_parameters(s, ccid_header);
  884. ccid_write_parameters(s, ccid_header);
  885. break;
  886. case CCID_MESSAGE_TYPE_PC_to_RDR_ResetParameters:
  887. ccid_reset_error_status(s);
  888. ccid_reset_parameters(s);
  889. ccid_write_parameters(s, ccid_header);
  890. break;
  891. case CCID_MESSAGE_TYPE_PC_to_RDR_GetParameters:
  892. ccid_reset_error_status(s);
  893. ccid_write_parameters(s, ccid_header);
  894. break;
  895. default:
  896. DPRINTF(s, 1,
  897. "handle_data: ERROR: unhandled message type %Xh\n",
  898. ccid_header->bMessageType);
  899. /*
  900. * The caller is expecting the device to respond, tell it we
  901. * don't support the operation.
  902. */
  903. ccid_report_error_failed(s, ERROR_CMD_NOT_SUPPORTED);
  904. ccid_write_slot_status(s, ccid_header);
  905. break;
  906. }
  907. }
  908. s->bulk_out_pos = 0;
  909. return 0;
  910. }
  911. static int ccid_bulk_in_copy_to_guest(USBCCIDState *s, uint8_t *data, int len)
  912. {
  913. int ret = 0;
  914. assert(len > 0);
  915. ccid_bulk_in_get(s);
  916. if (s->current_bulk_in != NULL) {
  917. ret = MIN(s->current_bulk_in->len - s->current_bulk_in->pos, len);
  918. memcpy(data, s->current_bulk_in->data + s->current_bulk_in->pos, ret);
  919. s->current_bulk_in->pos += ret;
  920. if (s->current_bulk_in->pos == s->current_bulk_in->len) {
  921. ccid_bulk_in_release(s);
  922. }
  923. } else {
  924. /* return when device has no data - usb 2.0 spec Table 8-4 */
  925. ret = USB_RET_NAK;
  926. }
  927. if (ret > 0) {
  928. DPRINTF(s, D_MORE_INFO,
  929. "%s: %d/%d req/act to guest (BULK_IN)\n", __func__, len, ret);
  930. }
  931. if (ret != USB_RET_NAK && ret < len) {
  932. DPRINTF(s, 1,
  933. "%s: returning short (EREMOTEIO) %d < %d\n", __func__, ret, len);
  934. }
  935. return ret;
  936. }
  937. static int ccid_handle_data(USBDevice *dev, USBPacket *p)
  938. {
  939. USBCCIDState *s = DO_UPCAST(USBCCIDState, dev, dev);
  940. int ret = 0;
  941. uint8_t *data = p->data;
  942. int len = p->len;
  943. switch (p->pid) {
  944. case USB_TOKEN_OUT:
  945. ret = ccid_handle_bulk_out(s, p);
  946. break;
  947. case USB_TOKEN_IN:
  948. switch (p->devep & 0xf) {
  949. case CCID_BULK_IN_EP:
  950. if (!len) {
  951. ret = USB_RET_NAK;
  952. } else {
  953. ret = ccid_bulk_in_copy_to_guest(s, data, len);
  954. }
  955. break;
  956. case CCID_INT_IN_EP:
  957. if (s->notify_slot_change) {
  958. /* page 56, RDR_to_PC_NotifySlotChange */
  959. data[0] = CCID_MESSAGE_TYPE_RDR_to_PC_NotifySlotChange;
  960. data[1] = s->bmSlotICCState;
  961. ret = 2;
  962. s->notify_slot_change = false;
  963. s->bmSlotICCState &= ~SLOT_0_CHANGED_MASK;
  964. DPRINTF(s, D_INFO,
  965. "handle_data: int_in: notify_slot_change %X, "
  966. "requested len %d\n",
  967. s->bmSlotICCState, len);
  968. }
  969. break;
  970. default:
  971. DPRINTF(s, 1, "Bad endpoint\n");
  972. break;
  973. }
  974. break;
  975. default:
  976. DPRINTF(s, 1, "Bad token\n");
  977. ret = USB_RET_STALL;
  978. break;
  979. }
  980. return ret;
  981. }
  982. static void ccid_handle_destroy(USBDevice *dev)
  983. {
  984. USBCCIDState *s = DO_UPCAST(USBCCIDState, dev, dev);
  985. ccid_bulk_in_clear(s);
  986. }
  987. static void ccid_flush_pending_answers(USBCCIDState *s)
  988. {
  989. while (ccid_has_pending_answers(s)) {
  990. ccid_write_data_block_answer(s, NULL, 0);
  991. }
  992. }
  993. static Answer *ccid_peek_next_answer(USBCCIDState *s)
  994. {
  995. return s->pending_answers_num == 0
  996. ? NULL
  997. : &s->pending_answers[s->pending_answers_start % PENDING_ANSWERS_NUM];
  998. }
  999. static struct BusInfo ccid_bus_info = {
  1000. .name = "ccid-bus",
  1001. .size = sizeof(CCIDBus),
  1002. .props = (Property[]) {
  1003. DEFINE_PROP_UINT32("slot", struct CCIDCardState, slot, 0),
  1004. DEFINE_PROP_END_OF_LIST(),
  1005. }
  1006. };
  1007. void ccid_card_send_apdu_to_guest(CCIDCardState *card,
  1008. uint8_t *apdu, uint32_t len)
  1009. {
  1010. USBCCIDState *s = DO_UPCAST(USBCCIDState, dev.qdev,
  1011. card->qdev.parent_bus->parent);
  1012. Answer *answer;
  1013. if (!ccid_has_pending_answers(s)) {
  1014. DPRINTF(s, 1, "CCID ERROR: got an APDU without pending answers\n");
  1015. return;
  1016. }
  1017. s->bmCommandStatus = COMMAND_STATUS_NO_ERROR;
  1018. answer = ccid_peek_next_answer(s);
  1019. if (answer == NULL) {
  1020. abort();
  1021. }
  1022. DPRINTF(s, 1, "APDU returned to guest %d (answer seq %d, slot %d)\n",
  1023. len, answer->seq, answer->slot);
  1024. ccid_write_data_block_answer(s, apdu, len);
  1025. }
  1026. void ccid_card_card_removed(CCIDCardState *card)
  1027. {
  1028. USBCCIDState *s =
  1029. DO_UPCAST(USBCCIDState, dev.qdev, card->qdev.parent_bus->parent);
  1030. ccid_on_slot_change(s, false);
  1031. ccid_flush_pending_answers(s);
  1032. ccid_reset(s);
  1033. }
  1034. int ccid_card_ccid_attach(CCIDCardState *card)
  1035. {
  1036. USBCCIDState *s =
  1037. DO_UPCAST(USBCCIDState, dev.qdev, card->qdev.parent_bus->parent);
  1038. DPRINTF(s, 1, "CCID Attach\n");
  1039. if (s->migration_state == MIGRATION_MIGRATED) {
  1040. s->migration_state = MIGRATION_NONE;
  1041. }
  1042. return 0;
  1043. }
  1044. void ccid_card_ccid_detach(CCIDCardState *card)
  1045. {
  1046. USBCCIDState *s =
  1047. DO_UPCAST(USBCCIDState, dev.qdev, card->qdev.parent_bus->parent);
  1048. DPRINTF(s, 1, "CCID Detach\n");
  1049. if (ccid_card_inserted(s)) {
  1050. ccid_on_slot_change(s, false);
  1051. }
  1052. ccid_detach(s);
  1053. }
  1054. void ccid_card_card_error(CCIDCardState *card, uint64_t error)
  1055. {
  1056. USBCCIDState *s =
  1057. DO_UPCAST(USBCCIDState, dev.qdev, card->qdev.parent_bus->parent);
  1058. s->bmCommandStatus = COMMAND_STATUS_FAILED;
  1059. s->last_answer_error = error;
  1060. DPRINTF(s, 1, "VSC_Error: %" PRIX64 "\n", s->last_answer_error);
  1061. /* TODO: these errors should be more verbose and propagated to the guest.*/
  1062. /*
  1063. * We flush all pending answers on CardRemove message in ccid-card-passthru,
  1064. * so check that first to not trigger abort
  1065. */
  1066. if (ccid_has_pending_answers(s)) {
  1067. ccid_write_data_block_answer(s, NULL, 0);
  1068. }
  1069. }
  1070. void ccid_card_card_inserted(CCIDCardState *card)
  1071. {
  1072. USBCCIDState *s =
  1073. DO_UPCAST(USBCCIDState, dev.qdev, card->qdev.parent_bus->parent);
  1074. s->bmCommandStatus = COMMAND_STATUS_NO_ERROR;
  1075. ccid_flush_pending_answers(s);
  1076. ccid_on_slot_change(s, true);
  1077. }
  1078. static int ccid_card_exit(DeviceState *qdev)
  1079. {
  1080. int ret = 0;
  1081. CCIDCardState *card = DO_UPCAST(CCIDCardState, qdev, qdev);
  1082. CCIDCardInfo *info = DO_UPCAST(CCIDCardInfo, qdev, qdev->info);
  1083. USBCCIDState *s =
  1084. DO_UPCAST(USBCCIDState, dev.qdev, card->qdev.parent_bus->parent);
  1085. if (ccid_card_inserted(s)) {
  1086. ccid_card_card_removed(card);
  1087. }
  1088. if (info->exitfn) {
  1089. ret = info->exitfn(card);
  1090. }
  1091. s->card = NULL;
  1092. s->cardinfo = NULL;
  1093. return ret;
  1094. }
  1095. static int ccid_card_init(DeviceState *qdev, DeviceInfo *base)
  1096. {
  1097. CCIDCardState *card = DO_UPCAST(CCIDCardState, qdev, qdev);
  1098. CCIDCardInfo *info = DO_UPCAST(CCIDCardInfo, qdev, base);
  1099. USBCCIDState *s =
  1100. DO_UPCAST(USBCCIDState, dev.qdev, card->qdev.parent_bus->parent);
  1101. int ret = 0;
  1102. if (card->slot != 0) {
  1103. error_report("Warning: usb-ccid supports one slot, can't add %d",
  1104. card->slot);
  1105. return -1;
  1106. }
  1107. if (s->card != NULL) {
  1108. error_report("Warning: usb-ccid card already full, not adding");
  1109. return -1;
  1110. }
  1111. ret = info->initfn ? info->initfn(card) : ret;
  1112. if (ret == 0) {
  1113. s->card = card;
  1114. s->cardinfo = info;
  1115. }
  1116. return ret;
  1117. }
  1118. void ccid_card_qdev_register(CCIDCardInfo *card)
  1119. {
  1120. card->qdev.bus_info = &ccid_bus_info;
  1121. card->qdev.init = ccid_card_init;
  1122. card->qdev.exit = ccid_card_exit;
  1123. qdev_register(&card->qdev);
  1124. }
  1125. static int ccid_initfn(USBDevice *dev)
  1126. {
  1127. USBCCIDState *s = DO_UPCAST(USBCCIDState, dev, dev);
  1128. qbus_create_inplace(&s->bus.qbus, &ccid_bus_info, &dev->qdev, NULL);
  1129. s->bus.qbus.allow_hotplug = 1;
  1130. s->card = NULL;
  1131. s->cardinfo = NULL;
  1132. s->migration_state = MIGRATION_NONE;
  1133. s->migration_target_ip = 0;
  1134. s->migration_target_port = 0;
  1135. s->dev.speed = USB_SPEED_FULL;
  1136. s->dev.speedmask = USB_SPEED_MASK_FULL;
  1137. s->notify_slot_change = false;
  1138. s->powered = true;
  1139. s->pending_answers_num = 0;
  1140. s->last_answer_error = 0;
  1141. s->bulk_in_pending_start = 0;
  1142. s->bulk_in_pending_end = 0;
  1143. s->current_bulk_in = NULL;
  1144. ccid_reset_error_status(s);
  1145. s->bulk_out_pos = 0;
  1146. ccid_reset_parameters(s);
  1147. ccid_reset(s);
  1148. return 0;
  1149. }
  1150. static int ccid_post_load(void *opaque, int version_id)
  1151. {
  1152. USBCCIDState *s = opaque;
  1153. /*
  1154. * This must be done after usb_device_attach, which sets state to ATTACHED,
  1155. * while it must be DEFAULT in order to accept packets (like it is after
  1156. * reset, but reset will reset our addr and call our reset handler which
  1157. * may change state, and we don't want to do that when migrating).
  1158. */
  1159. s->dev.state = s->state_vmstate;
  1160. return 0;
  1161. }
  1162. static void ccid_pre_save(void *opaque)
  1163. {
  1164. USBCCIDState *s = opaque;
  1165. s->state_vmstate = s->dev.state;
  1166. if (s->dev.attached) {
  1167. /*
  1168. * Migrating an open device, ignore reconnection CHR_EVENT to avoid an
  1169. * erroneous detach.
  1170. */
  1171. s->migration_state = MIGRATION_MIGRATED;
  1172. }
  1173. }
  1174. static VMStateDescription bulk_in_vmstate = {
  1175. .name = "CCID BulkIn state",
  1176. .version_id = 1,
  1177. .minimum_version_id = 1,
  1178. .fields = (VMStateField[]) {
  1179. VMSTATE_BUFFER(data, BulkIn),
  1180. VMSTATE_UINT32(len, BulkIn),
  1181. VMSTATE_UINT32(pos, BulkIn),
  1182. VMSTATE_END_OF_LIST()
  1183. }
  1184. };
  1185. static VMStateDescription answer_vmstate = {
  1186. .name = "CCID Answer state",
  1187. .version_id = 1,
  1188. .minimum_version_id = 1,
  1189. .fields = (VMStateField[]) {
  1190. VMSTATE_UINT8(slot, Answer),
  1191. VMSTATE_UINT8(seq, Answer),
  1192. VMSTATE_END_OF_LIST()
  1193. }
  1194. };
  1195. static VMStateDescription usb_device_vmstate = {
  1196. .name = "usb_device",
  1197. .version_id = 1,
  1198. .minimum_version_id = 1,
  1199. .fields = (VMStateField[]) {
  1200. VMSTATE_UINT8(addr, USBDevice),
  1201. VMSTATE_BUFFER(setup_buf, USBDevice),
  1202. VMSTATE_BUFFER(data_buf, USBDevice),
  1203. VMSTATE_END_OF_LIST()
  1204. }
  1205. };
  1206. static VMStateDescription ccid_vmstate = {
  1207. .name = CCID_DEV_NAME,
  1208. .version_id = 1,
  1209. .minimum_version_id = 1,
  1210. .post_load = ccid_post_load,
  1211. .pre_save = ccid_pre_save,
  1212. .fields = (VMStateField[]) {
  1213. VMSTATE_STRUCT(dev, USBCCIDState, 1, usb_device_vmstate, USBDevice),
  1214. VMSTATE_UINT8(debug, USBCCIDState),
  1215. VMSTATE_BUFFER(bulk_out_data, USBCCIDState),
  1216. VMSTATE_UINT32(bulk_out_pos, USBCCIDState),
  1217. VMSTATE_UINT8(bmSlotICCState, USBCCIDState),
  1218. VMSTATE_UINT8(powered, USBCCIDState),
  1219. VMSTATE_UINT8(notify_slot_change, USBCCIDState),
  1220. VMSTATE_UINT64(last_answer_error, USBCCIDState),
  1221. VMSTATE_UINT8(bError, USBCCIDState),
  1222. VMSTATE_UINT8(bmCommandStatus, USBCCIDState),
  1223. VMSTATE_UINT8(bProtocolNum, USBCCIDState),
  1224. VMSTATE_BUFFER(abProtocolDataStructure, USBCCIDState),
  1225. VMSTATE_UINT32(ulProtocolDataStructureSize, USBCCIDState),
  1226. VMSTATE_STRUCT_ARRAY(bulk_in_pending, USBCCIDState,
  1227. BULK_IN_PENDING_NUM, 1, bulk_in_vmstate, BulkIn),
  1228. VMSTATE_UINT32(bulk_in_pending_start, USBCCIDState),
  1229. VMSTATE_UINT32(bulk_in_pending_end, USBCCIDState),
  1230. VMSTATE_STRUCT_ARRAY(pending_answers, USBCCIDState,
  1231. PENDING_ANSWERS_NUM, 1, answer_vmstate, Answer),
  1232. VMSTATE_UINT32(pending_answers_num, USBCCIDState),
  1233. VMSTATE_UINT8(migration_state, USBCCIDState),
  1234. VMSTATE_UINT32(state_vmstate, USBCCIDState),
  1235. VMSTATE_END_OF_LIST()
  1236. }
  1237. };
  1238. static struct USBDeviceInfo ccid_info = {
  1239. .product_desc = "QEMU USB CCID",
  1240. .qdev.name = CCID_DEV_NAME,
  1241. .qdev.desc = "CCID Rev 1.1 smartcard reader",
  1242. .qdev.size = sizeof(USBCCIDState),
  1243. .init = ccid_initfn,
  1244. .handle_packet = usb_generic_handle_packet,
  1245. .handle_reset = ccid_handle_reset,
  1246. .handle_control = ccid_handle_control,
  1247. .handle_data = ccid_handle_data,
  1248. .handle_destroy = ccid_handle_destroy,
  1249. .usbdevice_name = "ccid",
  1250. .qdev.props = (Property[]) {
  1251. DEFINE_PROP_UINT8("debug", USBCCIDState, debug, 0),
  1252. DEFINE_PROP_END_OF_LIST(),
  1253. },
  1254. .qdev.vmsd = &ccid_vmstate,
  1255. };
  1256. static void ccid_register_devices(void)
  1257. {
  1258. usb_qdev_register(&ccid_info);
  1259. }
  1260. device_init(ccid_register_devices)