root / hw / ccid-card-passthru.c @ edbb2136
History | View | Annotate | Download (10.2 kB)
1 |
/*
|
---|---|
2 |
* CCID Passthru Card Device emulation
|
3 |
*
|
4 |
* Copyright (c) 2011 Red Hat.
|
5 |
* Written by Alon Levy.
|
6 |
*
|
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 |
*/
|
10 |
|
11 |
#include <arpa/inet.h> |
12 |
|
13 |
#include "qemu-char.h" |
14 |
#include "monitor.h" |
15 |
#include "hw/ccid.h" |
16 |
#include "libcacard/vscard_common.h" |
17 |
|
18 |
#define DPRINTF(card, lvl, fmt, ...) \
|
19 |
do { \
|
20 |
if (lvl <= card->debug) { \
|
21 |
printf("ccid-card-passthru: " fmt , ## __VA_ARGS__); \ |
22 |
} \ |
23 |
} while (0) |
24 |
|
25 |
#define D_WARN 1 |
26 |
#define D_INFO 2 |
27 |
#define D_MORE_INFO 3 |
28 |
#define D_VERBOSE 4 |
29 |
|
30 |
/* TODO: do we still need this? */
|
31 |
uint8_t DEFAULT_ATR[] = { |
32 |
/*
|
33 |
* From some example somewhere
|
34 |
* 0x3B, 0xB0, 0x18, 0x00, 0xD1, 0x81, 0x05, 0xB1, 0x40, 0x38, 0x1F, 0x03, 0x28
|
35 |
*/
|
36 |
|
37 |
/* From an Athena smart card */
|
38 |
0x3B, 0xD5, 0x18, 0xFF, 0x80, 0x91, 0xFE, 0x1F, 0xC3, 0x80, 0x73, 0xC8, 0x21, |
39 |
0x13, 0x08 |
40 |
}; |
41 |
|
42 |
|
43 |
#define PASSTHRU_DEV_NAME "ccid-card-passthru" |
44 |
#define VSCARD_IN_SIZE 65536 |
45 |
|
46 |
/* maximum size of ATR - from 7816-3 */
|
47 |
#define MAX_ATR_SIZE 40 |
48 |
|
49 |
typedef struct PassthruState PassthruState; |
50 |
|
51 |
struct PassthruState {
|
52 |
CCIDCardState base; |
53 |
CharDriverState *cs; |
54 |
uint8_t vscard_in_data[VSCARD_IN_SIZE]; |
55 |
uint32_t vscard_in_pos; |
56 |
uint32_t vscard_in_hdr; |
57 |
uint8_t atr[MAX_ATR_SIZE]; |
58 |
uint8_t atr_length; |
59 |
uint8_t debug; |
60 |
}; |
61 |
|
62 |
/*
|
63 |
* VSCard protocol over chardev
|
64 |
* This code should not depend on the card type.
|
65 |
*/
|
66 |
|
67 |
static void ccid_card_vscard_send_msg(PassthruState *s, |
68 |
VSCMsgType type, uint32_t reader_id, |
69 |
const uint8_t *payload, uint32_t length)
|
70 |
{ |
71 |
VSCMsgHeader scr_msg_header; |
72 |
|
73 |
scr_msg_header.type = htonl(type); |
74 |
scr_msg_header.reader_id = htonl(reader_id); |
75 |
scr_msg_header.length = htonl(length); |
76 |
qemu_chr_write(s->cs, (uint8_t *)&scr_msg_header, sizeof(VSCMsgHeader));
|
77 |
qemu_chr_write(s->cs, payload, length); |
78 |
} |
79 |
|
80 |
static void ccid_card_vscard_send_apdu(PassthruState *s, |
81 |
const uint8_t *apdu, uint32_t length)
|
82 |
{ |
83 |
ccid_card_vscard_send_msg( |
84 |
s, VSC_APDU, VSCARD_MINIMAL_READER_ID, apdu, length); |
85 |
} |
86 |
|
87 |
static void ccid_card_vscard_send_error(PassthruState *s, |
88 |
uint32_t reader_id, VSCErrorCode code) |
89 |
{ |
90 |
VSCMsgError msg = {.code = htonl(code)}; |
91 |
|
92 |
ccid_card_vscard_send_msg( |
93 |
s, VSC_Error, reader_id, (uint8_t *)&msg, sizeof(msg));
|
94 |
} |
95 |
|
96 |
static void ccid_card_vscard_send_init(PassthruState *s) |
97 |
{ |
98 |
VSCMsgInit msg = { |
99 |
.version = htonl(VSCARD_VERSION), |
100 |
.magic = VSCARD_MAGIC, |
101 |
.capabilities = {0}
|
102 |
}; |
103 |
|
104 |
ccid_card_vscard_send_msg(s, VSC_Init, VSCARD_UNDEFINED_READER_ID, |
105 |
(uint8_t *)&msg, sizeof(msg));
|
106 |
} |
107 |
|
108 |
static int ccid_card_vscard_can_read(void *opaque) |
109 |
{ |
110 |
PassthruState *card = opaque; |
111 |
|
112 |
return VSCARD_IN_SIZE >= card->vscard_in_pos ?
|
113 |
VSCARD_IN_SIZE - card->vscard_in_pos : 0;
|
114 |
} |
115 |
|
116 |
static void ccid_card_vscard_handle_init( |
117 |
PassthruState *card, VSCMsgHeader *hdr, VSCMsgInit *init) |
118 |
{ |
119 |
uint32_t *capabilities; |
120 |
int num_capabilities;
|
121 |
int i;
|
122 |
|
123 |
capabilities = init->capabilities; |
124 |
num_capabilities = |
125 |
1 + ((hdr->length - sizeof(VSCMsgInit)) / sizeof(uint32_t)); |
126 |
init->version = ntohl(init->version); |
127 |
for (i = 0 ; i < num_capabilities; ++i) { |
128 |
capabilities[i] = ntohl(capabilities[i]); |
129 |
} |
130 |
if (init->magic != VSCARD_MAGIC) {
|
131 |
error_report("wrong magic");
|
132 |
/* we can't disconnect the chardev */
|
133 |
} |
134 |
if (init->version != VSCARD_VERSION) {
|
135 |
DPRINTF(card, D_WARN, |
136 |
"got version %d, have %d", init->version, VSCARD_VERSION);
|
137 |
} |
138 |
/* future handling of capabilities, none exist atm */
|
139 |
ccid_card_vscard_send_init(card); |
140 |
} |
141 |
|
142 |
static void ccid_card_vscard_handle_message(PassthruState *card, |
143 |
VSCMsgHeader *scr_msg_header) |
144 |
{ |
145 |
uint8_t *data = (uint8_t *)&scr_msg_header[1];
|
146 |
|
147 |
switch (scr_msg_header->type) {
|
148 |
case VSC_ATR:
|
149 |
DPRINTF(card, D_INFO, "VSC_ATR %d\n", scr_msg_header->length);
|
150 |
if (scr_msg_header->length > MAX_ATR_SIZE) {
|
151 |
error_report("ATR size exceeds spec, ignoring");
|
152 |
ccid_card_vscard_send_error(card, scr_msg_header->reader_id, |
153 |
VSC_GENERAL_ERROR); |
154 |
} |
155 |
memcpy(card->atr, data, scr_msg_header->length); |
156 |
card->atr_length = scr_msg_header->length; |
157 |
ccid_card_card_inserted(&card->base); |
158 |
ccid_card_vscard_send_error(card, scr_msg_header->reader_id, |
159 |
VSC_SUCCESS); |
160 |
break;
|
161 |
case VSC_APDU:
|
162 |
ccid_card_send_apdu_to_guest( |
163 |
&card->base, data, scr_msg_header->length); |
164 |
break;
|
165 |
case VSC_CardRemove:
|
166 |
DPRINTF(card, D_INFO, "VSC_CardRemove\n");
|
167 |
ccid_card_card_removed(&card->base); |
168 |
ccid_card_vscard_send_error(card, |
169 |
scr_msg_header->reader_id, VSC_SUCCESS); |
170 |
break;
|
171 |
case VSC_Init:
|
172 |
ccid_card_vscard_handle_init( |
173 |
card, scr_msg_header, (VSCMsgInit *)data); |
174 |
break;
|
175 |
case VSC_Error:
|
176 |
ccid_card_card_error(&card->base, *(uint32_t *)data); |
177 |
break;
|
178 |
case VSC_ReaderAdd:
|
179 |
if (ccid_card_ccid_attach(&card->base) < 0) { |
180 |
ccid_card_vscard_send_error(card, VSCARD_UNDEFINED_READER_ID, |
181 |
VSC_CANNOT_ADD_MORE_READERS); |
182 |
} else {
|
183 |
ccid_card_vscard_send_error(card, VSCARD_MINIMAL_READER_ID, |
184 |
VSC_SUCCESS); |
185 |
} |
186 |
break;
|
187 |
case VSC_ReaderRemove:
|
188 |
ccid_card_ccid_detach(&card->base); |
189 |
ccid_card_vscard_send_error(card, |
190 |
scr_msg_header->reader_id, VSC_SUCCESS); |
191 |
break;
|
192 |
default:
|
193 |
printf("usb-ccid: chardev: unexpected message of type %X\n",
|
194 |
scr_msg_header->type); |
195 |
ccid_card_vscard_send_error(card, scr_msg_header->reader_id, |
196 |
VSC_GENERAL_ERROR); |
197 |
} |
198 |
} |
199 |
|
200 |
static void ccid_card_vscard_drop_connection(PassthruState *card) |
201 |
{ |
202 |
qemu_chr_close(card->cs); |
203 |
card->vscard_in_pos = card->vscard_in_hdr = 0;
|
204 |
} |
205 |
|
206 |
static void ccid_card_vscard_read(void *opaque, const uint8_t *buf, int size) |
207 |
{ |
208 |
PassthruState *card = opaque; |
209 |
VSCMsgHeader *hdr; |
210 |
|
211 |
if (card->vscard_in_pos + size > VSCARD_IN_SIZE) {
|
212 |
error_report( |
213 |
"no room for data: pos %d + size %d > %d. dropping connection.",
|
214 |
card->vscard_in_pos, size, VSCARD_IN_SIZE); |
215 |
ccid_card_vscard_drop_connection(card); |
216 |
return;
|
217 |
} |
218 |
assert(card->vscard_in_pos < VSCARD_IN_SIZE); |
219 |
assert(card->vscard_in_hdr < VSCARD_IN_SIZE); |
220 |
memcpy(card->vscard_in_data + card->vscard_in_pos, buf, size); |
221 |
card->vscard_in_pos += size; |
222 |
hdr = (VSCMsgHeader *)(card->vscard_in_data + card->vscard_in_hdr); |
223 |
|
224 |
while ((card->vscard_in_pos - card->vscard_in_hdr >= sizeof(VSCMsgHeader)) |
225 |
&&(card->vscard_in_pos - card->vscard_in_hdr >= |
226 |
sizeof(VSCMsgHeader) + ntohl(hdr->length))) {
|
227 |
hdr->reader_id = ntohl(hdr->reader_id); |
228 |
hdr->length = ntohl(hdr->length); |
229 |
hdr->type = ntohl(hdr->type); |
230 |
ccid_card_vscard_handle_message(card, hdr); |
231 |
card->vscard_in_hdr += hdr->length + sizeof(VSCMsgHeader);
|
232 |
hdr = (VSCMsgHeader *)(card->vscard_in_data + card->vscard_in_hdr); |
233 |
} |
234 |
if (card->vscard_in_hdr == card->vscard_in_pos) {
|
235 |
card->vscard_in_pos = card->vscard_in_hdr = 0;
|
236 |
} |
237 |
} |
238 |
|
239 |
static void ccid_card_vscard_event(void *opaque, int event) |
240 |
{ |
241 |
PassthruState *card = opaque; |
242 |
|
243 |
switch (event) {
|
244 |
case CHR_EVENT_BREAK:
|
245 |
card->vscard_in_pos = card->vscard_in_hdr = 0;
|
246 |
break;
|
247 |
case CHR_EVENT_FOCUS:
|
248 |
break;
|
249 |
case CHR_EVENT_OPENED:
|
250 |
DPRINTF(card, D_INFO, "%s: CHR_EVENT_OPENED\n", __func__);
|
251 |
break;
|
252 |
} |
253 |
} |
254 |
|
255 |
/* End VSCard handling */
|
256 |
|
257 |
static void passthru_apdu_from_guest( |
258 |
CCIDCardState *base, const uint8_t *apdu, uint32_t len)
|
259 |
{ |
260 |
PassthruState *card = DO_UPCAST(PassthruState, base, base); |
261 |
|
262 |
if (!card->cs) {
|
263 |
printf("ccid-passthru: no chardev, discarding apdu length %d\n", len);
|
264 |
return;
|
265 |
} |
266 |
ccid_card_vscard_send_apdu(card, apdu, len); |
267 |
} |
268 |
|
269 |
static const uint8_t *passthru_get_atr(CCIDCardState *base, uint32_t *len) |
270 |
{ |
271 |
PassthruState *card = DO_UPCAST(PassthruState, base, base); |
272 |
|
273 |
*len = card->atr_length; |
274 |
return card->atr;
|
275 |
} |
276 |
|
277 |
static int passthru_initfn(CCIDCardState *base) |
278 |
{ |
279 |
PassthruState *card = DO_UPCAST(PassthruState, base, base); |
280 |
|
281 |
card->vscard_in_pos = 0;
|
282 |
card->vscard_in_hdr = 0;
|
283 |
if (card->cs) {
|
284 |
DPRINTF(card, D_INFO, "initing chardev\n");
|
285 |
qemu_chr_add_handlers(card->cs, |
286 |
ccid_card_vscard_can_read, |
287 |
ccid_card_vscard_read, |
288 |
ccid_card_vscard_event, card); |
289 |
ccid_card_vscard_send_init(card); |
290 |
} else {
|
291 |
error_report("missing chardev");
|
292 |
return -1; |
293 |
} |
294 |
assert(sizeof(DEFAULT_ATR) <= MAX_ATR_SIZE);
|
295 |
memcpy(card->atr, DEFAULT_ATR, sizeof(DEFAULT_ATR));
|
296 |
card->atr_length = sizeof(DEFAULT_ATR);
|
297 |
return 0; |
298 |
} |
299 |
|
300 |
static int passthru_exitfn(CCIDCardState *base) |
301 |
{ |
302 |
return 0; |
303 |
} |
304 |
|
305 |
static VMStateDescription passthru_vmstate = {
|
306 |
.name = PASSTHRU_DEV_NAME, |
307 |
.version_id = 1,
|
308 |
.minimum_version_id = 1,
|
309 |
.fields = (VMStateField[]) { |
310 |
VMSTATE_BUFFER(vscard_in_data, PassthruState), |
311 |
VMSTATE_UINT32(vscard_in_pos, PassthruState), |
312 |
VMSTATE_UINT32(vscard_in_hdr, PassthruState), |
313 |
VMSTATE_BUFFER(atr, PassthruState), |
314 |
VMSTATE_UINT8(atr_length, PassthruState), |
315 |
VMSTATE_END_OF_LIST() |
316 |
} |
317 |
}; |
318 |
|
319 |
static CCIDCardInfo passthru_card_info = {
|
320 |
.qdev.name = PASSTHRU_DEV_NAME, |
321 |
.qdev.desc = "passthrough smartcard",
|
322 |
.qdev.size = sizeof(PassthruState),
|
323 |
.qdev.vmsd = &passthru_vmstate, |
324 |
.initfn = passthru_initfn, |
325 |
.exitfn = passthru_exitfn, |
326 |
.get_atr = passthru_get_atr, |
327 |
.apdu_from_guest = passthru_apdu_from_guest, |
328 |
.qdev.props = (Property[]) { |
329 |
DEFINE_PROP_CHR("chardev", PassthruState, cs),
|
330 |
DEFINE_PROP_UINT8("debug", PassthruState, debug, 0), |
331 |
DEFINE_PROP_END_OF_LIST(), |
332 |
}, |
333 |
}; |
334 |
|
335 |
static void ccid_card_passthru_register_devices(void) |
336 |
{ |
337 |
ccid_card_qdev_register(&passthru_card_info); |
338 |
} |
339 |
|
340 |
device_init(ccid_card_passthru_register_devices) |