pc_piix: set qxl revision to 2 for pc-0.14
[qemu/ar7.git] / hw / ccid-card-passthru.c
blob2cbc81b9f455cbc1088cb5befb78f4b0f2624ccd
1 /*
2 * CCID Passthru Card Device emulation
4 * Copyright (c) 2011 Red Hat.
5 * Written by Alon Levy.
7 * This work is licensed under the terms of the GNU GPL, version 2.1 or later.
8 * See the COPYING file in the top-level directory.
9 */
11 #include "qemu-char.h"
12 #include "qemu_socket.h"
13 #include "monitor.h"
14 #include "hw/ccid.h"
15 #include "libcacard/vscard_common.h"
17 #define DPRINTF(card, lvl, fmt, ...) \
18 do { \
19 if (lvl <= card->debug) { \
20 printf("ccid-card-passthru: " fmt , ## __VA_ARGS__); \
21 } \
22 } while (0)
24 #define D_WARN 1
25 #define D_INFO 2
26 #define D_MORE_INFO 3
27 #define D_VERBOSE 4
29 /* TODO: do we still need this? */
30 uint8_t DEFAULT_ATR[] = {
32 * From some example somewhere
33 * 0x3B, 0xB0, 0x18, 0x00, 0xD1, 0x81, 0x05, 0xB1, 0x40, 0x38, 0x1F, 0x03, 0x28
36 /* From an Athena smart card */
37 0x3B, 0xD5, 0x18, 0xFF, 0x80, 0x91, 0xFE, 0x1F, 0xC3, 0x80, 0x73, 0xC8, 0x21,
38 0x13, 0x08
42 #define PASSTHRU_DEV_NAME "ccid-card-passthru"
43 #define VSCARD_IN_SIZE 65536
45 /* maximum size of ATR - from 7816-3 */
46 #define MAX_ATR_SIZE 40
48 typedef struct PassthruState PassthruState;
50 struct PassthruState {
51 CCIDCardState base;
52 CharDriverState *cs;
53 uint8_t vscard_in_data[VSCARD_IN_SIZE];
54 uint32_t vscard_in_pos;
55 uint32_t vscard_in_hdr;
56 uint8_t atr[MAX_ATR_SIZE];
57 uint8_t atr_length;
58 uint8_t debug;
62 * VSCard protocol over chardev
63 * This code should not depend on the card type.
66 static void ccid_card_vscard_send_msg(PassthruState *s,
67 VSCMsgType type, uint32_t reader_id,
68 const uint8_t *payload, uint32_t length)
70 VSCMsgHeader scr_msg_header;
72 scr_msg_header.type = htonl(type);
73 scr_msg_header.reader_id = htonl(reader_id);
74 scr_msg_header.length = htonl(length);
75 qemu_chr_fe_write(s->cs, (uint8_t *)&scr_msg_header, sizeof(VSCMsgHeader));
76 qemu_chr_fe_write(s->cs, payload, length);
79 static void ccid_card_vscard_send_apdu(PassthruState *s,
80 const uint8_t *apdu, uint32_t length)
82 ccid_card_vscard_send_msg(
83 s, VSC_APDU, VSCARD_MINIMAL_READER_ID, apdu, length);
86 static void ccid_card_vscard_send_error(PassthruState *s,
87 uint32_t reader_id, VSCErrorCode code)
89 VSCMsgError msg = {.code = htonl(code)};
91 ccid_card_vscard_send_msg(
92 s, VSC_Error, reader_id, (uint8_t *)&msg, sizeof(msg));
95 static void ccid_card_vscard_send_init(PassthruState *s)
97 VSCMsgInit msg = {
98 .version = htonl(VSCARD_VERSION),
99 .magic = VSCARD_MAGIC,
100 .capabilities = {0}
103 ccid_card_vscard_send_msg(s, VSC_Init, VSCARD_UNDEFINED_READER_ID,
104 (uint8_t *)&msg, sizeof(msg));
107 static int ccid_card_vscard_can_read(void *opaque)
109 PassthruState *card = opaque;
111 return VSCARD_IN_SIZE >= card->vscard_in_pos ?
112 VSCARD_IN_SIZE - card->vscard_in_pos : 0;
115 static void ccid_card_vscard_handle_init(
116 PassthruState *card, VSCMsgHeader *hdr, VSCMsgInit *init)
118 uint32_t *capabilities;
119 int num_capabilities;
120 int i;
122 capabilities = init->capabilities;
123 num_capabilities =
124 1 + ((hdr->length - sizeof(VSCMsgInit)) / sizeof(uint32_t));
125 init->version = ntohl(init->version);
126 for (i = 0 ; i < num_capabilities; ++i) {
127 capabilities[i] = ntohl(capabilities[i]);
129 if (init->magic != VSCARD_MAGIC) {
130 error_report("wrong magic");
131 /* we can't disconnect the chardev */
133 if (init->version != VSCARD_VERSION) {
134 DPRINTF(card, D_WARN,
135 "got version %d, have %d", init->version, VSCARD_VERSION);
137 /* future handling of capabilities, none exist atm */
138 ccid_card_vscard_send_init(card);
141 static void ccid_card_vscard_handle_message(PassthruState *card,
142 VSCMsgHeader *scr_msg_header)
144 uint8_t *data = (uint8_t *)&scr_msg_header[1];
146 switch (scr_msg_header->type) {
147 case VSC_ATR:
148 DPRINTF(card, D_INFO, "VSC_ATR %d\n", scr_msg_header->length);
149 if (scr_msg_header->length > MAX_ATR_SIZE) {
150 error_report("ATR size exceeds spec, ignoring");
151 ccid_card_vscard_send_error(card, scr_msg_header->reader_id,
152 VSC_GENERAL_ERROR);
154 memcpy(card->atr, data, scr_msg_header->length);
155 card->atr_length = scr_msg_header->length;
156 ccid_card_card_inserted(&card->base);
157 ccid_card_vscard_send_error(card, scr_msg_header->reader_id,
158 VSC_SUCCESS);
159 break;
160 case VSC_APDU:
161 ccid_card_send_apdu_to_guest(
162 &card->base, data, scr_msg_header->length);
163 break;
164 case VSC_CardRemove:
165 DPRINTF(card, D_INFO, "VSC_CardRemove\n");
166 ccid_card_card_removed(&card->base);
167 ccid_card_vscard_send_error(card,
168 scr_msg_header->reader_id, VSC_SUCCESS);
169 break;
170 case VSC_Init:
171 ccid_card_vscard_handle_init(
172 card, scr_msg_header, (VSCMsgInit *)data);
173 break;
174 case VSC_Error:
175 ccid_card_card_error(&card->base, *(uint32_t *)data);
176 break;
177 case VSC_ReaderAdd:
178 if (ccid_card_ccid_attach(&card->base) < 0) {
179 ccid_card_vscard_send_error(card, VSCARD_UNDEFINED_READER_ID,
180 VSC_CANNOT_ADD_MORE_READERS);
181 } else {
182 ccid_card_vscard_send_error(card, VSCARD_MINIMAL_READER_ID,
183 VSC_SUCCESS);
185 break;
186 case VSC_ReaderRemove:
187 ccid_card_ccid_detach(&card->base);
188 ccid_card_vscard_send_error(card,
189 scr_msg_header->reader_id, VSC_SUCCESS);
190 break;
191 default:
192 printf("usb-ccid: chardev: unexpected message of type %X\n",
193 scr_msg_header->type);
194 ccid_card_vscard_send_error(card, scr_msg_header->reader_id,
195 VSC_GENERAL_ERROR);
199 static void ccid_card_vscard_drop_connection(PassthruState *card)
201 qemu_chr_delete(card->cs);
202 card->vscard_in_pos = card->vscard_in_hdr = 0;
205 static void ccid_card_vscard_read(void *opaque, const uint8_t *buf, int size)
207 PassthruState *card = opaque;
208 VSCMsgHeader *hdr;
210 if (card->vscard_in_pos + size > VSCARD_IN_SIZE) {
211 error_report(
212 "no room for data: pos %d + size %d > %d. dropping connection.",
213 card->vscard_in_pos, size, VSCARD_IN_SIZE);
214 ccid_card_vscard_drop_connection(card);
215 return;
217 assert(card->vscard_in_pos < VSCARD_IN_SIZE);
218 assert(card->vscard_in_hdr < VSCARD_IN_SIZE);
219 memcpy(card->vscard_in_data + card->vscard_in_pos, buf, size);
220 card->vscard_in_pos += size;
221 hdr = (VSCMsgHeader *)(card->vscard_in_data + card->vscard_in_hdr);
223 while ((card->vscard_in_pos - card->vscard_in_hdr >= sizeof(VSCMsgHeader))
224 &&(card->vscard_in_pos - card->vscard_in_hdr >=
225 sizeof(VSCMsgHeader) + ntohl(hdr->length))) {
226 hdr->reader_id = ntohl(hdr->reader_id);
227 hdr->length = ntohl(hdr->length);
228 hdr->type = ntohl(hdr->type);
229 ccid_card_vscard_handle_message(card, hdr);
230 card->vscard_in_hdr += hdr->length + sizeof(VSCMsgHeader);
231 hdr = (VSCMsgHeader *)(card->vscard_in_data + card->vscard_in_hdr);
233 if (card->vscard_in_hdr == card->vscard_in_pos) {
234 card->vscard_in_pos = card->vscard_in_hdr = 0;
238 static void ccid_card_vscard_event(void *opaque, int event)
240 PassthruState *card = opaque;
242 switch (event) {
243 case CHR_EVENT_BREAK:
244 card->vscard_in_pos = card->vscard_in_hdr = 0;
245 break;
246 case CHR_EVENT_FOCUS:
247 break;
248 case CHR_EVENT_OPENED:
249 DPRINTF(card, D_INFO, "%s: CHR_EVENT_OPENED\n", __func__);
250 break;
254 /* End VSCard handling */
256 static void passthru_apdu_from_guest(
257 CCIDCardState *base, const uint8_t *apdu, uint32_t len)
259 PassthruState *card = DO_UPCAST(PassthruState, base, base);
261 if (!card->cs) {
262 printf("ccid-passthru: no chardev, discarding apdu length %d\n", len);
263 return;
265 ccid_card_vscard_send_apdu(card, apdu, len);
268 static const uint8_t *passthru_get_atr(CCIDCardState *base, uint32_t *len)
270 PassthruState *card = DO_UPCAST(PassthruState, base, base);
272 *len = card->atr_length;
273 return card->atr;
276 static int passthru_initfn(CCIDCardState *base)
278 PassthruState *card = DO_UPCAST(PassthruState, base, base);
280 card->vscard_in_pos = 0;
281 card->vscard_in_hdr = 0;
282 if (card->cs) {
283 DPRINTF(card, D_INFO, "initing chardev\n");
284 qemu_chr_add_handlers(card->cs,
285 ccid_card_vscard_can_read,
286 ccid_card_vscard_read,
287 ccid_card_vscard_event, card);
288 ccid_card_vscard_send_init(card);
289 } else {
290 error_report("missing chardev");
291 return -1;
293 assert(sizeof(DEFAULT_ATR) <= MAX_ATR_SIZE);
294 memcpy(card->atr, DEFAULT_ATR, sizeof(DEFAULT_ATR));
295 card->atr_length = sizeof(DEFAULT_ATR);
296 return 0;
299 static int passthru_exitfn(CCIDCardState *base)
301 return 0;
304 static VMStateDescription passthru_vmstate = {
305 .name = PASSTHRU_DEV_NAME,
306 .version_id = 1,
307 .minimum_version_id = 1,
308 .fields = (VMStateField[]) {
309 VMSTATE_BUFFER(vscard_in_data, PassthruState),
310 VMSTATE_UINT32(vscard_in_pos, PassthruState),
311 VMSTATE_UINT32(vscard_in_hdr, PassthruState),
312 VMSTATE_BUFFER(atr, PassthruState),
313 VMSTATE_UINT8(atr_length, PassthruState),
314 VMSTATE_END_OF_LIST()
318 static CCIDCardInfo passthru_card_info = {
319 .qdev.name = PASSTHRU_DEV_NAME,
320 .qdev.desc = "passthrough smartcard",
321 .qdev.size = sizeof(PassthruState),
322 .qdev.vmsd = &passthru_vmstate,
323 .initfn = passthru_initfn,
324 .exitfn = passthru_exitfn,
325 .get_atr = passthru_get_atr,
326 .apdu_from_guest = passthru_apdu_from_guest,
327 .qdev.props = (Property[]) {
328 DEFINE_PROP_CHR("chardev", PassthruState, cs),
329 DEFINE_PROP_UINT8("debug", PassthruState, debug, 0),
330 DEFINE_PROP_END_OF_LIST(),
334 static void ccid_card_passthru_register_devices(void)
336 ccid_card_qdev_register(&passthru_card_info);
339 device_init(ccid_card_passthru_register_devices)