xref: /freebsd/contrib/wpa/src/utils/pcsc_funcs.c (revision 4d846d260e2b9a3d4d0a701462568268cbfe7a5b)
1 /*
2  * WPA Supplicant / PC/SC smartcard interface for USIM, GSM SIM
3  * Copyright (c) 2004-2007, 2012, Jouni Malinen <j@w1.fi>
4  *
5  * This software may be distributed under the terms of the BSD license.
6  * See README for more details.
7  *
8  * This file implements wrapper functions for accessing GSM SIM and 3GPP USIM
9  * cards through PC/SC smartcard library. These functions are used to implement
10  * authentication routines for EAP-SIM and EAP-AKA.
11  */
12 
13 #include "includes.h"
14 #ifdef __APPLE__
15 #include <PCSC/winscard.h>
16 #else
17 #include <winscard.h>
18 #endif
19 
20 #include "common.h"
21 #include "pcsc_funcs.h"
22 
23 
24 /* See ETSI GSM 11.11 and ETSI TS 102 221 for details.
25  * SIM commands:
26  * Command APDU: CLA INS P1 P2 P3 Data
27  *   CLA (class of instruction): A0 for GSM, 00 for USIM
28  *   INS (instruction)
29  *   P1 P2 P3 (parameters, P3 = length of Data)
30  * Response APDU: Data SW1 SW2
31  *   SW1 SW2 (Status words)
32  * Commands (INS P1 P2 P3):
33  *   SELECT: A4 00 00 02 <file_id, 2 bytes>
34  *   GET RESPONSE: C0 00 00 <len>
35  *   RUN GSM ALG: 88 00 00 00 <RAND len = 10>
36  *   RUN UMTS ALG: 88 00 81 <len=0x22> data: 0x10 | RAND | 0x10 | AUTN
37  *	P1 = ID of alg in card
38  *	P2 = ID of secret key
39  *   READ BINARY: B0 <offset high> <offset low> <len>
40  *   READ RECORD: B2 <record number> <mode> <len>
41  *	P2 (mode) = '02' (next record), '03' (previous record),
42  *		    '04' (absolute mode)
43  *   VERIFY CHV: 20 00 <CHV number> 08
44  *   CHANGE CHV: 24 00 <CHV number> 10
45  *   DISABLE CHV: 26 00 01 08
46  *   ENABLE CHV: 28 00 01 08
47  *   UNBLOCK CHV: 2C 00 <00=CHV1, 02=CHV2> 10
48  *   SLEEP: FA 00 00 00
49  */
50 
51 /* GSM SIM commands */
52 #define SIM_CMD_SELECT			0xa0, 0xa4, 0x00, 0x00, 0x02
53 #define SIM_CMD_RUN_GSM_ALG		0xa0, 0x88, 0x00, 0x00, 0x10
54 #define SIM_CMD_GET_RESPONSE		0xa0, 0xc0, 0x00, 0x00
55 #define SIM_CMD_READ_BIN		0xa0, 0xb0, 0x00, 0x00
56 #define SIM_CMD_READ_RECORD		0xa0, 0xb2, 0x00, 0x00
57 #define SIM_CMD_VERIFY_CHV1		0xa0, 0x20, 0x00, 0x01, 0x08
58 
59 /* USIM commands */
60 #define USIM_CLA			0x00
61 #define USIM_CMD_RUN_UMTS_ALG		0x00, 0x88, 0x00, 0x81, 0x22
62 #define USIM_CMD_GET_RESPONSE		0x00, 0xc0, 0x00, 0x00
63 
64 #define SIM_RECORD_MODE_ABSOLUTE 0x04
65 
66 #define USIM_FSP_TEMPL_TAG		0x62
67 
68 #define USIM_TLV_FILE_DESC		0x82
69 #define USIM_TLV_FILE_ID		0x83
70 #define USIM_TLV_DF_NAME		0x84
71 #define USIM_TLV_PROPR_INFO		0xA5
72 #define USIM_TLV_LIFE_CYCLE_STATUS	0x8A
73 #define USIM_TLV_FILE_SIZE		0x80
74 #define USIM_TLV_TOTAL_FILE_SIZE	0x81
75 #define USIM_TLV_PIN_STATUS_TEMPLATE	0xC6
76 #define USIM_TLV_SHORT_FILE_ID		0x88
77 #define USIM_TLV_SECURITY_ATTR_8B	0x8B
78 #define USIM_TLV_SECURITY_ATTR_8C	0x8C
79 #define USIM_TLV_SECURITY_ATTR_AB	0xAB
80 
81 #define USIM_PS_DO_TAG			0x90
82 
83 #define AKA_RAND_LEN 16
84 #define AKA_AUTN_LEN 16
85 #define AKA_AUTS_LEN 14
86 #define RES_MAX_LEN 16
87 #define IK_LEN 16
88 #define CK_LEN 16
89 
90 
91 /* GSM files
92  * File type in first octet:
93  * 3F = Master File
94  * 7F = Dedicated File
95  * 2F = Elementary File under the Master File
96  * 6F = Elementary File under a Dedicated File
97  */
98 #define SCARD_FILE_MF		0x3F00
99 #define SCARD_FILE_GSM_DF	0x7F20
100 #define SCARD_FILE_UMTS_DF	0x7F50
101 #define SCARD_FILE_GSM_EF_IMSI	0x6F07
102 #define SCARD_FILE_GSM_EF_AD	0x6FAD
103 #define SCARD_FILE_EF_DIR	0x2F00
104 #define SCARD_FILE_EF_ICCID	0x2FE2
105 #define SCARD_FILE_EF_CK	0x6FE1
106 #define SCARD_FILE_EF_IK	0x6FE2
107 
108 #define SCARD_CHV1_OFFSET	13
109 #define SCARD_CHV1_FLAG		0x80
110 
111 
112 typedef enum { SCARD_GSM_SIM, SCARD_USIM } sim_types;
113 
114 struct scard_data {
115 	SCARDCONTEXT ctx;
116 	SCARDHANDLE card;
117 #ifdef __APPLE__
118 	uint32_t protocol;
119 #else
120 	DWORD protocol;
121 #endif
122 	sim_types sim_type;
123 	int pin1_required;
124 };
125 
126 #ifdef __MINGW32_VERSION
127 /* MinGW does not yet support WinScard, so load the needed functions
128  * dynamically from winscard.dll for now. */
129 
130 static HINSTANCE dll = NULL; /* winscard.dll */
131 
132 static const SCARD_IO_REQUEST *dll_g_rgSCardT0Pci, *dll_g_rgSCardT1Pci;
133 #undef SCARD_PCI_T0
134 #define SCARD_PCI_T0 (dll_g_rgSCardT0Pci)
135 #undef SCARD_PCI_T1
136 #define SCARD_PCI_T1 (dll_g_rgSCardT1Pci)
137 
138 
139 static WINSCARDAPI LONG WINAPI
140 (*dll_SCardEstablishContext)(IN DWORD dwScope,
141 			     IN LPCVOID pvReserved1,
142 			     IN LPCVOID pvReserved2,
143 			     OUT LPSCARDCONTEXT phContext);
144 #define SCardEstablishContext dll_SCardEstablishContext
145 
146 static long (*dll_SCardReleaseContext)(long hContext);
147 #define SCardReleaseContext dll_SCardReleaseContext
148 
149 static WINSCARDAPI LONG WINAPI
150 (*dll_SCardListReadersA)(IN SCARDCONTEXT hContext,
151 			 IN LPCSTR mszGroups,
152 			 OUT LPSTR mszReaders,
153 			 IN OUT LPDWORD pcchReaders);
154 #undef SCardListReaders
155 #define SCardListReaders dll_SCardListReadersA
156 
157 static WINSCARDAPI LONG WINAPI
158 (*dll_SCardConnectA)(IN SCARDCONTEXT hContext,
159 		     IN LPCSTR szReader,
160 		     IN DWORD dwShareMode,
161 		     IN DWORD dwPreferredProtocols,
162 		     OUT LPSCARDHANDLE phCard,
163 		     OUT LPDWORD pdwActiveProtocol);
164 #undef SCardConnect
165 #define SCardConnect dll_SCardConnectA
166 
167 static WINSCARDAPI LONG WINAPI
168 (*dll_SCardDisconnect)(IN SCARDHANDLE hCard,
169 		       IN DWORD dwDisposition);
170 #define SCardDisconnect dll_SCardDisconnect
171 
172 static WINSCARDAPI LONG WINAPI
173 (*dll_SCardTransmit)(IN SCARDHANDLE hCard,
174 		     IN LPCSCARD_IO_REQUEST pioSendPci,
175 		     IN LPCBYTE pbSendBuffer,
176 		     IN DWORD cbSendLength,
177 		     IN OUT LPSCARD_IO_REQUEST pioRecvPci,
178 		     OUT LPBYTE pbRecvBuffer,
179 		     IN OUT LPDWORD pcbRecvLength);
180 #define SCardTransmit dll_SCardTransmit
181 
182 static WINSCARDAPI LONG WINAPI
183 (*dll_SCardBeginTransaction)(IN SCARDHANDLE hCard);
184 #define SCardBeginTransaction dll_SCardBeginTransaction
185 
186 static WINSCARDAPI LONG WINAPI
187 (*dll_SCardEndTransaction)(IN SCARDHANDLE hCard, IN DWORD dwDisposition);
188 #define SCardEndTransaction dll_SCardEndTransaction
189 
190 
191 static int mingw_load_symbols(void)
192 {
193 	char *sym;
194 
195 	if (dll)
196 		return 0;
197 
198 	dll = LoadLibrary("winscard");
199 	if (dll == NULL) {
200 		wpa_printf(MSG_DEBUG, "WinSCard: Could not load winscard.dll "
201 			   "library");
202 		return -1;
203 	}
204 
205 #define LOADSYM(s) \
206 	sym = #s; \
207 	dll_ ## s = (void *) GetProcAddress(dll, sym); \
208 	if (dll_ ## s == NULL) \
209 		goto fail;
210 
211 	LOADSYM(SCardEstablishContext);
212 	LOADSYM(SCardReleaseContext);
213 	LOADSYM(SCardListReadersA);
214 	LOADSYM(SCardConnectA);
215 	LOADSYM(SCardDisconnect);
216 	LOADSYM(SCardTransmit);
217 	LOADSYM(SCardBeginTransaction);
218 	LOADSYM(SCardEndTransaction);
219 	LOADSYM(g_rgSCardT0Pci);
220 	LOADSYM(g_rgSCardT1Pci);
221 
222 #undef LOADSYM
223 
224 	return 0;
225 
226 fail:
227 	wpa_printf(MSG_DEBUG, "WinSCard: Could not get address for %s from "
228 		   "winscard.dll", sym);
229 	FreeLibrary(dll);
230 	dll = NULL;
231 	return -1;
232 }
233 
234 
235 static void mingw_unload_symbols(void)
236 {
237 	if (dll == NULL)
238 		return;
239 
240 	FreeLibrary(dll);
241 	dll = NULL;
242 }
243 
244 #else /* __MINGW32_VERSION */
245 
246 #define mingw_load_symbols() 0
247 #define mingw_unload_symbols() do { } while (0)
248 
249 #endif /* __MINGW32_VERSION */
250 
251 
252 static int _scard_select_file(struct scard_data *scard, unsigned short file_id,
253 			      unsigned char *buf, size_t *buf_len,
254 			      sim_types sim_type, unsigned char *aid,
255 			      size_t aidlen);
256 static int scard_select_file(struct scard_data *scard, unsigned short file_id,
257 			     unsigned char *buf, size_t *buf_len);
258 static int scard_verify_pin(struct scard_data *scard, const char *pin);
259 static int scard_get_record_len(struct scard_data *scard,
260 				unsigned char recnum, unsigned char mode);
261 static int scard_read_record(struct scard_data *scard,
262 			     unsigned char *data, size_t len,
263 			     unsigned char recnum, unsigned char mode);
264 
265 
266 static int scard_parse_fsp_templ(unsigned char *buf, size_t buf_len,
267 				 int *ps_do, int *file_len)
268 {
269 	unsigned char *pos, *end;
270 
271 	if (ps_do)
272 		*ps_do = -1;
273 	if (file_len)
274 		*file_len = -1;
275 
276 	pos = buf;
277 	end = pos + buf_len;
278 	if (*pos != USIM_FSP_TEMPL_TAG) {
279 		wpa_printf(MSG_DEBUG, "SCARD: file header did not "
280 			   "start with FSP template tag");
281 		return -1;
282 	}
283 	pos++;
284 	if (pos >= end)
285 		return -1;
286 	if (pos[0] < end - pos)
287 		end = pos + 1 + pos[0];
288 	pos++;
289 	wpa_hexdump(MSG_DEBUG, "SCARD: file header FSP template",
290 		    pos, end - pos);
291 
292 	while (end - pos >= 2) {
293 		unsigned char type, len;
294 
295 		type = pos[0];
296 		len = pos[1];
297 		wpa_printf(MSG_MSGDUMP, "SCARD: file header TLV 0x%02x len=%d",
298 			   type, len);
299 		pos += 2;
300 
301 		if (len > (unsigned int) (end - pos))
302 			break;
303 
304 		switch (type) {
305 		case USIM_TLV_FILE_DESC:
306 			wpa_hexdump(MSG_MSGDUMP, "SCARD: File Descriptor TLV",
307 				    pos, len);
308 			break;
309 		case USIM_TLV_FILE_ID:
310 			wpa_hexdump(MSG_MSGDUMP, "SCARD: File Identifier TLV",
311 				    pos, len);
312 			break;
313 		case USIM_TLV_DF_NAME:
314 			wpa_hexdump(MSG_MSGDUMP, "SCARD: DF name (AID) TLV",
315 				    pos, len);
316 			break;
317 		case USIM_TLV_PROPR_INFO:
318 			wpa_hexdump(MSG_MSGDUMP, "SCARD: Proprietary "
319 				    "information TLV", pos, len);
320 			break;
321 		case USIM_TLV_LIFE_CYCLE_STATUS:
322 			wpa_hexdump(MSG_MSGDUMP, "SCARD: Life Cycle Status "
323 				    "Integer TLV", pos, len);
324 			break;
325 		case USIM_TLV_FILE_SIZE:
326 			wpa_hexdump(MSG_MSGDUMP, "SCARD: File size TLV",
327 				    pos, len);
328 			if ((len == 1 || len == 2) && file_len) {
329 				if (len == 1)
330 					*file_len = (int) pos[0];
331 				else
332 					*file_len = WPA_GET_BE16(pos);
333 				wpa_printf(MSG_DEBUG, "SCARD: file_size=%d",
334 					   *file_len);
335 			}
336 			break;
337 		case USIM_TLV_TOTAL_FILE_SIZE:
338 			wpa_hexdump(MSG_MSGDUMP, "SCARD: Total file size TLV",
339 				    pos, len);
340 			break;
341 		case USIM_TLV_PIN_STATUS_TEMPLATE:
342 			wpa_hexdump(MSG_MSGDUMP, "SCARD: PIN Status Template "
343 				    "DO TLV", pos, len);
344 			if (len >= 2 && pos[0] == USIM_PS_DO_TAG &&
345 			    pos[1] >= 1 && ps_do) {
346 				wpa_printf(MSG_DEBUG, "SCARD: PS_DO=0x%02x",
347 					   pos[2]);
348 				*ps_do = (int) pos[2];
349 			}
350 			break;
351 		case USIM_TLV_SHORT_FILE_ID:
352 			wpa_hexdump(MSG_MSGDUMP, "SCARD: Short File "
353 				    "Identifier (SFI) TLV", pos, len);
354 			break;
355 		case USIM_TLV_SECURITY_ATTR_8B:
356 		case USIM_TLV_SECURITY_ATTR_8C:
357 		case USIM_TLV_SECURITY_ATTR_AB:
358 			wpa_hexdump(MSG_MSGDUMP, "SCARD: Security attribute "
359 				    "TLV", pos, len);
360 			break;
361 		default:
362 			wpa_hexdump(MSG_MSGDUMP, "SCARD: Unrecognized TLV",
363 				    pos, len);
364 			break;
365 		}
366 
367 		pos += len;
368 
369 		if (pos == end)
370 			return 0;
371 	}
372 	return -1;
373 }
374 
375 
376 static int scard_pin_needed(struct scard_data *scard,
377 			    unsigned char *hdr, size_t hlen)
378 {
379 	if (scard->sim_type == SCARD_GSM_SIM) {
380 		if (hlen > SCARD_CHV1_OFFSET &&
381 		    !(hdr[SCARD_CHV1_OFFSET] & SCARD_CHV1_FLAG))
382 			return 1;
383 		return 0;
384 	}
385 
386 	if (scard->sim_type == SCARD_USIM) {
387 		int ps_do;
388 		if (scard_parse_fsp_templ(hdr, hlen, &ps_do, NULL))
389 			return -1;
390 		/* TODO: there could be more than one PS_DO entry because of
391 		 * multiple PINs in key reference.. */
392 		if (ps_do > 0 && (ps_do & 0x80))
393 			return 1;
394 		return 0;
395 	}
396 
397 	return -1;
398 }
399 
400 
401 static int scard_get_aid(struct scard_data *scard, unsigned char *aid,
402 			 size_t maxlen)
403 {
404 	int rlen, rec;
405 	struct efdir {
406 		unsigned char appl_template_tag; /* 0x61 */
407 		unsigned char appl_template_len;
408 		unsigned char appl_id_tag; /* 0x4f */
409 		unsigned char aid_len;
410 		unsigned char rid[5];
411 		unsigned char appl_code[2]; /* 0x1002 for 3G USIM */
412 	} *efdir;
413 	unsigned char buf[127], *aid_pos;
414 	size_t blen;
415 	unsigned int aid_len = 0;
416 
417 	efdir = (struct efdir *) buf;
418 	aid_pos = &buf[4];
419 	blen = sizeof(buf);
420 	if (scard_select_file(scard, SCARD_FILE_EF_DIR, buf, &blen)) {
421 		wpa_printf(MSG_DEBUG, "SCARD: Failed to read EF_DIR");
422 		return -1;
423 	}
424 	wpa_hexdump(MSG_DEBUG, "SCARD: EF_DIR select", buf, blen);
425 
426 	for (rec = 1; rec < 10; rec++) {
427 		rlen = scard_get_record_len(scard, rec,
428 					    SIM_RECORD_MODE_ABSOLUTE);
429 		if (rlen < 0) {
430 			wpa_printf(MSG_DEBUG, "SCARD: Failed to get EF_DIR "
431 				   "record length");
432 			return -1;
433 		}
434 		blen = sizeof(buf);
435 		if (rlen > (int) blen) {
436 			wpa_printf(MSG_DEBUG, "SCARD: Too long EF_DIR record");
437 			return -1;
438 		}
439 		if (scard_read_record(scard, buf, rlen, rec,
440 				      SIM_RECORD_MODE_ABSOLUTE) < 0) {
441 			wpa_printf(MSG_DEBUG, "SCARD: Failed to read "
442 				   "EF_DIR record %d", rec);
443 			return -1;
444 		}
445 		wpa_hexdump(MSG_DEBUG, "SCARD: EF_DIR record", buf, rlen);
446 
447 		if (efdir->appl_template_tag != 0x61) {
448 			wpa_printf(MSG_DEBUG, "SCARD: Unexpected application "
449 				   "template tag 0x%x",
450 				   efdir->appl_template_tag);
451 			continue;
452 		}
453 
454 		if (efdir->appl_template_len > rlen - 2) {
455 			wpa_printf(MSG_DEBUG, "SCARD: Too long application "
456 				   "template (len=%d rlen=%d)",
457 				   efdir->appl_template_len, rlen);
458 			continue;
459 		}
460 
461 		if (efdir->appl_id_tag != 0x4f) {
462 			wpa_printf(MSG_DEBUG, "SCARD: Unexpected application "
463 				   "identifier tag 0x%x", efdir->appl_id_tag);
464 			continue;
465 		}
466 
467 		aid_len = efdir->aid_len;
468 		if (aid_len < 1 || aid_len > 16) {
469 			wpa_printf(MSG_DEBUG, "SCARD: Invalid AID length %u",
470 				   aid_len);
471 			continue;
472 		}
473 
474 		wpa_hexdump(MSG_DEBUG, "SCARD: AID from EF_DIR record",
475 			    aid_pos, aid_len);
476 
477 		if (efdir->appl_code[0] == 0x10 &&
478 		    efdir->appl_code[1] == 0x02) {
479 			wpa_printf(MSG_DEBUG, "SCARD: 3G USIM app found from "
480 				   "EF_DIR record %d", rec);
481 			break;
482 		}
483 	}
484 
485 	if (rec >= 10) {
486 		wpa_printf(MSG_DEBUG, "SCARD: 3G USIM app not found "
487 			   "from EF_DIR records");
488 		return -1;
489 	}
490 
491 	if (aid_len > maxlen) {
492 		wpa_printf(MSG_DEBUG, "SCARD: Too long AID");
493 		return -1;
494 	}
495 
496 	os_memcpy(aid, aid_pos, aid_len);
497 
498 	return aid_len;
499 }
500 
501 
502 /**
503  * scard_init - Initialize SIM/USIM connection using PC/SC
504  * @reader: Reader name prefix to search for
505  * Returns: Pointer to private data structure, or %NULL on failure
506  *
507  * This function is used to initialize SIM/USIM connection. PC/SC is used to
508  * open connection to the SIM/USIM card. In addition, local flag is set if a
509  * PIN is needed to access some of the card functions. Once the connection is
510  * not needed anymore, scard_deinit() can be used to close it.
511  */
512 struct scard_data * scard_init(const char *reader)
513 {
514 	long ret;
515 #ifdef __APPLE__
516 	uint32_t len;
517 #else
518 	unsigned long len;
519 #endif
520 	unsigned long pos;
521 	struct scard_data *scard;
522 #ifdef CONFIG_NATIVE_WINDOWS
523 	TCHAR *readers = NULL;
524 #else /* CONFIG_NATIVE_WINDOWS */
525 	char *readers = NULL;
526 #endif /* CONFIG_NATIVE_WINDOWS */
527 	unsigned char buf[100];
528 	size_t blen;
529 	int transaction = 0;
530 	int pin_needed;
531 
532 	wpa_printf(MSG_DEBUG, "SCARD: initializing smart card interface");
533 	if (mingw_load_symbols())
534 		return NULL;
535 	scard = os_zalloc(sizeof(*scard));
536 	if (scard == NULL)
537 		return NULL;
538 
539 	ret = SCardEstablishContext(SCARD_SCOPE_SYSTEM, NULL, NULL,
540 				    &scard->ctx);
541 	if (ret != SCARD_S_SUCCESS) {
542 		wpa_printf(MSG_DEBUG, "SCARD: Could not establish smart card "
543 			   "context (err=%ld)", ret);
544 		goto failed;
545 	}
546 
547 	ret = SCardListReaders(scard->ctx, NULL, NULL, &len);
548 	if (ret != SCARD_S_SUCCESS) {
549 		wpa_printf(MSG_DEBUG, "SCARD: SCardListReaders failed "
550 			   "(err=%ld)", ret);
551 		goto failed;
552 	}
553 
554 #ifdef UNICODE
555 	len *= 2;
556 #endif /* UNICODE */
557 	readers = os_malloc(len);
558 	if (readers == NULL) {
559 		wpa_printf(MSG_INFO, "SCARD: malloc failed\n");
560 		goto failed;
561 	}
562 
563 	ret = SCardListReaders(scard->ctx, NULL, readers, &len);
564 	if (ret != SCARD_S_SUCCESS) {
565 		wpa_printf(MSG_DEBUG, "SCARD: SCardListReaders failed(2) "
566 			   "(err=%ld)", ret);
567 		goto failed;
568 	}
569 	if (len < 3) {
570 		wpa_printf(MSG_WARNING, "SCARD: No smart card readers "
571 			   "available.");
572 		goto failed;
573 	}
574 	wpa_hexdump_ascii(MSG_DEBUG, "SCARD: Readers", (u8 *) readers, len);
575 	/*
576 	 * readers is a list of available readers. The last entry is terminated
577 	 * with double null.
578 	 */
579 	pos = 0;
580 #ifdef UNICODE
581 	/* TODO */
582 #else /* UNICODE */
583 	while (pos < len) {
584 		if (reader == NULL ||
585 		    os_strncmp(&readers[pos], reader, os_strlen(reader)) == 0)
586 			break;
587 		while (pos < len && readers[pos])
588 			pos++;
589 		pos++; /* skip separating null */
590 		if (pos < len && readers[pos] == '\0')
591 			pos = len; /* double null terminates list */
592 	}
593 #endif /* UNICODE */
594 	if (pos >= len) {
595 		wpa_printf(MSG_WARNING, "SCARD: No reader with prefix '%s' "
596 			   "found", reader);
597 		goto failed;
598 	}
599 
600 #ifdef UNICODE
601 	wpa_printf(MSG_DEBUG, "SCARD: Selected reader='%S'", &readers[pos]);
602 #else /* UNICODE */
603 	wpa_printf(MSG_DEBUG, "SCARD: Selected reader='%s'", &readers[pos]);
604 #endif /* UNICODE */
605 
606 	ret = SCardConnect(scard->ctx, &readers[pos], SCARD_SHARE_SHARED,
607 			   SCARD_PROTOCOL_T0 | SCARD_PROTOCOL_T1,
608 			   &scard->card, &scard->protocol);
609 	if (ret != SCARD_S_SUCCESS) {
610 		if (ret == (long) SCARD_E_NO_SMARTCARD)
611 			wpa_printf(MSG_INFO, "No smart card inserted.");
612 		else
613 			wpa_printf(MSG_WARNING, "SCardConnect err=%lx", ret);
614 		goto failed;
615 	}
616 
617 	os_free(readers);
618 	readers = NULL;
619 
620 	wpa_printf(MSG_DEBUG, "SCARD: card=0x%x active_protocol=%lu (%s)",
621 		   (unsigned int) scard->card, (unsigned long) scard->protocol,
622 		   scard->protocol == SCARD_PROTOCOL_T0 ? "T0" : "T1");
623 
624 	ret = SCardBeginTransaction(scard->card);
625 	if (ret != SCARD_S_SUCCESS) {
626 		wpa_printf(MSG_DEBUG, "SCARD: Could not begin transaction: "
627 			   "0x%x", (unsigned int) ret);
628 		goto failed;
629 	}
630 	transaction = 1;
631 
632 	blen = sizeof(buf);
633 
634 	wpa_printf(MSG_DEBUG, "SCARD: verifying USIM support");
635 	if (_scard_select_file(scard, SCARD_FILE_MF, buf, &blen,
636 			       SCARD_USIM, NULL, 0)) {
637 		wpa_printf(MSG_DEBUG, "SCARD: USIM is not supported. Trying to use GSM SIM");
638 		scard->sim_type = SCARD_GSM_SIM;
639 	} else {
640 		wpa_printf(MSG_DEBUG, "SCARD: USIM is supported");
641 		scard->sim_type = SCARD_USIM;
642 	}
643 
644 	if (scard->sim_type == SCARD_GSM_SIM) {
645 		blen = sizeof(buf);
646 		if (scard_select_file(scard, SCARD_FILE_MF, buf, &blen)) {
647 			wpa_printf(MSG_DEBUG, "SCARD: Failed to read MF");
648 			goto failed;
649 		}
650 
651 		blen = sizeof(buf);
652 		if (scard_select_file(scard, SCARD_FILE_GSM_DF, buf, &blen)) {
653 			wpa_printf(MSG_DEBUG, "SCARD: Failed to read GSM DF");
654 			goto failed;
655 		}
656 	} else {
657 		unsigned char aid[32];
658 		int aid_len;
659 
660 		aid_len = scard_get_aid(scard, aid, sizeof(aid));
661 		if (aid_len < 0) {
662 			wpa_printf(MSG_DEBUG, "SCARD: Failed to find AID for "
663 				   "3G USIM app - try to use standard 3G RID");
664 			os_memcpy(aid, "\xa0\x00\x00\x00\x87", 5);
665 			aid_len = 5;
666 		}
667 		wpa_hexdump(MSG_DEBUG, "SCARD: 3G USIM AID", aid, aid_len);
668 
669 		/* Select based on AID = 3G RID from EF_DIR. This is usually
670 		 * starting with A0 00 00 00 87. */
671 		blen = sizeof(buf);
672 		if (_scard_select_file(scard, 0, buf, &blen, scard->sim_type,
673 				       aid, aid_len)) {
674 			wpa_printf(MSG_INFO, "SCARD: Failed to read 3G USIM "
675 				   "app");
676 			wpa_hexdump(MSG_INFO, "SCARD: 3G USIM AID",
677 				    aid, aid_len);
678 			goto failed;
679 		}
680 	}
681 
682 	/* Verify whether CHV1 (PIN1) is needed to access the card. */
683 	pin_needed = scard_pin_needed(scard, buf, blen);
684 	if (pin_needed < 0) {
685 		wpa_printf(MSG_DEBUG, "SCARD: Failed to determine whether PIN "
686 			   "is needed");
687 		goto failed;
688 	}
689 	if (pin_needed) {
690 		scard->pin1_required = 1;
691 		wpa_printf(MSG_DEBUG, "PIN1 needed for SIM access (retry "
692 			   "counter=%d)", scard_get_pin_retry_counter(scard));
693 	}
694 
695 	ret = SCardEndTransaction(scard->card, SCARD_LEAVE_CARD);
696 	if (ret != SCARD_S_SUCCESS) {
697 		wpa_printf(MSG_DEBUG, "SCARD: Could not end transaction: "
698 			   "0x%x", (unsigned int) ret);
699 	}
700 
701 	return scard;
702 
703 failed:
704 	if (transaction)
705 		SCardEndTransaction(scard->card, SCARD_LEAVE_CARD);
706 	os_free(readers);
707 	scard_deinit(scard);
708 	return NULL;
709 }
710 
711 
712 /**
713  * scard_set_pin - Set PIN (CHV1/PIN1) code for accessing SIM/USIM commands
714  * @scard: Pointer to private data from scard_init()
715  * @pin: PIN code as an ASCII string (e.g., "1234")
716  * Returns: 0 on success, -1 on failure
717  */
718 int scard_set_pin(struct scard_data *scard, const char *pin)
719 {
720 	if (scard == NULL)
721 		return -1;
722 
723 	/* Verify whether CHV1 (PIN1) is needed to access the card. */
724 	if (scard->pin1_required) {
725 		if (pin == NULL) {
726 			wpa_printf(MSG_DEBUG, "No PIN configured for SIM "
727 				   "access");
728 			return -1;
729 		}
730 		if (scard_verify_pin(scard, pin)) {
731 			wpa_printf(MSG_INFO, "PIN verification failed for "
732 				"SIM access");
733 			return -1;
734 		}
735 	}
736 
737 	return 0;
738 }
739 
740 
741 /**
742  * scard_deinit - Deinitialize SIM/USIM connection
743  * @scard: Pointer to private data from scard_init()
744  *
745  * This function closes the SIM/USIM connect opened with scard_init().
746  */
747 void scard_deinit(struct scard_data *scard)
748 {
749 	long ret;
750 
751 	if (scard == NULL)
752 		return;
753 
754 	wpa_printf(MSG_DEBUG, "SCARD: deinitializing smart card interface");
755 	if (scard->card) {
756 		ret = SCardDisconnect(scard->card, SCARD_UNPOWER_CARD);
757 		if (ret != SCARD_S_SUCCESS) {
758 			wpa_printf(MSG_DEBUG, "SCARD: Failed to disconnect "
759 				   "smart card (err=%ld)", ret);
760 		}
761 	}
762 
763 	if (scard->ctx) {
764 		ret = SCardReleaseContext(scard->ctx);
765 		if (ret != SCARD_S_SUCCESS) {
766 			wpa_printf(MSG_DEBUG, "Failed to release smart card "
767 				   "context (err=%ld)", ret);
768 		}
769 	}
770 	os_free(scard);
771 	mingw_unload_symbols();
772 }
773 
774 
775 static long scard_transmit(struct scard_data *scard,
776 			   unsigned char *_send, size_t send_len,
777 			   unsigned char *_recv, size_t *recv_len)
778 {
779 	long ret;
780 #ifdef __APPLE__
781 	uint32_t rlen;
782 #else
783 	unsigned long rlen;
784 #endif
785 
786 	wpa_hexdump_key(MSG_DEBUG, "SCARD: scard_transmit: send",
787 			_send, send_len);
788 	rlen = *recv_len;
789 	ret = SCardTransmit(scard->card,
790 			    scard->protocol == SCARD_PROTOCOL_T1 ?
791 			    SCARD_PCI_T1 : SCARD_PCI_T0,
792 			    _send, (unsigned long) send_len,
793 			    NULL, _recv, &rlen);
794 	*recv_len = rlen;
795 	if (ret == SCARD_S_SUCCESS) {
796 		wpa_hexdump(MSG_DEBUG, "SCARD: scard_transmit: recv",
797 			    _recv, rlen);
798 	} else {
799 		wpa_printf(MSG_WARNING, "SCARD: SCardTransmit failed "
800 			   "(err=0x%lx)", ret);
801 	}
802 	return ret;
803 }
804 
805 
806 static int _scard_select_file(struct scard_data *scard, unsigned short file_id,
807 			      unsigned char *buf, size_t *buf_len,
808 			      sim_types sim_type, unsigned char *aid,
809 			      size_t aidlen)
810 {
811 	long ret;
812 	unsigned char resp[3];
813 	unsigned char cmd[50] = { SIM_CMD_SELECT };
814 	int cmdlen;
815 	unsigned char get_resp[5] = { SIM_CMD_GET_RESPONSE };
816 	size_t len, rlen;
817 
818 	if (sim_type == SCARD_USIM) {
819 		cmd[0] = USIM_CLA;
820 		cmd[3] = 0x04;
821 		get_resp[0] = USIM_CLA;
822 	}
823 
824 	wpa_printf(MSG_DEBUG, "SCARD: select file %04x", file_id);
825 	if (aid) {
826 		wpa_hexdump(MSG_DEBUG, "SCARD: select file by AID",
827 			    aid, aidlen);
828 		if (5 + aidlen > sizeof(cmd))
829 			return -1;
830 		cmd[2] = 0x04; /* Select by AID */
831 		cmd[4] = aidlen; /* len */
832 		os_memcpy(cmd + 5, aid, aidlen);
833 		cmdlen = 5 + aidlen;
834 	} else {
835 		cmd[5] = file_id >> 8;
836 		cmd[6] = file_id & 0xff;
837 		cmdlen = 7;
838 	}
839 	len = sizeof(resp);
840 	ret = scard_transmit(scard, cmd, cmdlen, resp, &len);
841 	if (ret != SCARD_S_SUCCESS) {
842 		wpa_printf(MSG_WARNING, "SCARD: SCardTransmit failed "
843 			   "(err=0x%lx)", ret);
844 		return -1;
845 	}
846 
847 	if (len != 2) {
848 		wpa_printf(MSG_WARNING, "SCARD: unexpected resp len "
849 			   "%d (expected 2)", (int) len);
850 		return -1;
851 	}
852 
853 	if (resp[0] == 0x98 && resp[1] == 0x04) {
854 		/* Security status not satisfied (PIN_WLAN) */
855 		wpa_printf(MSG_WARNING, "SCARD: Security status not satisfied "
856 			   "(PIN_WLAN)");
857 		return -1;
858 	}
859 
860 	if (resp[0] == 0x6e) {
861 		wpa_printf(MSG_DEBUG, "SCARD: used CLA not supported");
862 		return -1;
863 	}
864 
865 	if (resp[0] != 0x6c && resp[0] != 0x9f && resp[0] != 0x61) {
866 		wpa_printf(MSG_WARNING, "SCARD: unexpected response 0x%02x "
867 			   "(expected 0x61, 0x6c, or 0x9f)", resp[0]);
868 		return -1;
869 	}
870 	/* Normal ending of command; resp[1] bytes available */
871 	get_resp[4] = resp[1];
872 	wpa_printf(MSG_DEBUG, "SCARD: trying to get response (%d bytes)",
873 		   resp[1]);
874 
875 	rlen = *buf_len;
876 	ret = scard_transmit(scard, get_resp, sizeof(get_resp), buf, &rlen);
877 	if (ret == SCARD_S_SUCCESS) {
878 		*buf_len = resp[1] < rlen ? resp[1] : rlen;
879 		return 0;
880 	}
881 
882 	wpa_printf(MSG_WARNING, "SCARD: SCardTransmit err=0x%lx\n", ret);
883 	return -1;
884 }
885 
886 
887 static int scard_select_file(struct scard_data *scard, unsigned short file_id,
888 			     unsigned char *buf, size_t *buf_len)
889 {
890 	return _scard_select_file(scard, file_id, buf, buf_len,
891 				  scard->sim_type, NULL, 0);
892 }
893 
894 
895 static int scard_get_record_len(struct scard_data *scard, unsigned char recnum,
896 				unsigned char mode)
897 {
898 	unsigned char buf[255];
899 	unsigned char cmd[5] = { SIM_CMD_READ_RECORD /* , len */ };
900 	size_t blen;
901 	long ret;
902 
903 	if (scard->sim_type == SCARD_USIM)
904 		cmd[0] = USIM_CLA;
905 	cmd[2] = recnum;
906 	cmd[3] = mode;
907 	cmd[4] = sizeof(buf);
908 
909 	blen = sizeof(buf);
910 	ret = scard_transmit(scard, cmd, sizeof(cmd), buf, &blen);
911 	if (ret != SCARD_S_SUCCESS) {
912 		wpa_printf(MSG_DEBUG, "SCARD: failed to determine file "
913 			   "length for record %d", recnum);
914 		return -1;
915 	}
916 
917 	wpa_hexdump(MSG_DEBUG, "SCARD: file length determination response",
918 		    buf, blen);
919 
920 	if (blen < 2 || (buf[0] != 0x6c && buf[0] != 0x67)) {
921 		wpa_printf(MSG_DEBUG, "SCARD: unexpected response to file "
922 			   "length determination");
923 		return -1;
924 	}
925 
926 	return buf[1];
927 }
928 
929 
930 static int scard_read_record(struct scard_data *scard,
931 			     unsigned char *data, size_t len,
932 			     unsigned char recnum, unsigned char mode)
933 {
934 	unsigned char cmd[5] = { SIM_CMD_READ_RECORD /* , len */ };
935 	size_t blen = len + 3;
936 	unsigned char *buf;
937 	long ret;
938 
939 	if (scard->sim_type == SCARD_USIM)
940 		cmd[0] = USIM_CLA;
941 	cmd[2] = recnum;
942 	cmd[3] = mode;
943 	cmd[4] = len;
944 
945 	buf = os_malloc(blen);
946 	if (buf == NULL)
947 		return -1;
948 
949 	ret = scard_transmit(scard, cmd, sizeof(cmd), buf, &blen);
950 	if (ret != SCARD_S_SUCCESS) {
951 		os_free(buf);
952 		return -2;
953 	}
954 	if (blen != len + 2) {
955 		wpa_printf(MSG_DEBUG, "SCARD: record read returned unexpected "
956 			   "length %ld (expected %ld)",
957 			   (long) blen, (long) len + 2);
958 		os_free(buf);
959 		return -3;
960 	}
961 
962 	if (buf[len] != 0x90 || buf[len + 1] != 0x00) {
963 		wpa_printf(MSG_DEBUG, "SCARD: record read returned unexpected "
964 			   "status %02x %02x (expected 90 00)",
965 			   buf[len], buf[len + 1]);
966 		os_free(buf);
967 		return -4;
968 	}
969 
970 	os_memcpy(data, buf, len);
971 	os_free(buf);
972 
973 	return 0;
974 }
975 
976 
977 static int scard_read_file(struct scard_data *scard,
978 			   unsigned char *data, size_t len)
979 {
980 	unsigned char cmd[5] = { SIM_CMD_READ_BIN /* , len */ };
981 	size_t blen = len + 3;
982 	unsigned char *buf;
983 	long ret;
984 
985 	cmd[4] = len;
986 
987 	buf = os_malloc(blen);
988 	if (buf == NULL)
989 		return -1;
990 
991 	if (scard->sim_type == SCARD_USIM)
992 		cmd[0] = USIM_CLA;
993 	ret = scard_transmit(scard, cmd, sizeof(cmd), buf, &blen);
994 	if (ret != SCARD_S_SUCCESS) {
995 		os_free(buf);
996 		return -2;
997 	}
998 	if (blen != len + 2) {
999 		wpa_printf(MSG_DEBUG, "SCARD: file read returned unexpected "
1000 			   "length %ld (expected %ld)",
1001 			   (long) blen, (long) len + 2);
1002 		os_free(buf);
1003 		return -3;
1004 	}
1005 
1006 	if (buf[len] != 0x90 || buf[len + 1] != 0x00) {
1007 		wpa_printf(MSG_DEBUG, "SCARD: file read returned unexpected "
1008 			   "status %02x %02x (expected 90 00)",
1009 			   buf[len], buf[len + 1]);
1010 		os_free(buf);
1011 		return -4;
1012 	}
1013 
1014 	os_memcpy(data, buf, len);
1015 	os_free(buf);
1016 
1017 	return 0;
1018 }
1019 
1020 
1021 static int scard_verify_pin(struct scard_data *scard, const char *pin)
1022 {
1023 	long ret;
1024 	unsigned char resp[3];
1025 	unsigned char cmd[5 + 8] = { SIM_CMD_VERIFY_CHV1 };
1026 	size_t len;
1027 
1028 	wpa_printf(MSG_DEBUG, "SCARD: verifying PIN");
1029 
1030 	if (pin == NULL || os_strlen(pin) > 8)
1031 		return -1;
1032 
1033 	if (scard->sim_type == SCARD_USIM)
1034 		cmd[0] = USIM_CLA;
1035 	os_memcpy(cmd + 5, pin, os_strlen(pin));
1036 	os_memset(cmd + 5 + os_strlen(pin), 0xff, 8 - os_strlen(pin));
1037 
1038 	len = sizeof(resp);
1039 	ret = scard_transmit(scard, cmd, sizeof(cmd), resp, &len);
1040 	if (ret != SCARD_S_SUCCESS)
1041 		return -2;
1042 
1043 	if (len != 2 || resp[0] != 0x90 || resp[1] != 0x00) {
1044 		wpa_printf(MSG_WARNING, "SCARD: PIN verification failed");
1045 		return -1;
1046 	}
1047 
1048 	wpa_printf(MSG_DEBUG, "SCARD: PIN verified successfully");
1049 	return 0;
1050 }
1051 
1052 
1053 int scard_get_pin_retry_counter(struct scard_data *scard)
1054 {
1055 	long ret;
1056 	unsigned char resp[3];
1057 	unsigned char cmd[5] = { SIM_CMD_VERIFY_CHV1 };
1058 	size_t len;
1059 	u16 val;
1060 
1061 	wpa_printf(MSG_DEBUG, "SCARD: fetching PIN retry counter");
1062 
1063 	if (scard->sim_type == SCARD_USIM)
1064 		cmd[0] = USIM_CLA;
1065 	cmd[4] = 0; /* Empty data */
1066 
1067 	len = sizeof(resp);
1068 	ret = scard_transmit(scard, cmd, sizeof(cmd), resp, &len);
1069 	if (ret != SCARD_S_SUCCESS)
1070 		return -2;
1071 
1072 	if (len != 2) {
1073 		wpa_printf(MSG_WARNING, "SCARD: failed to fetch PIN retry "
1074 			   "counter");
1075 		return -1;
1076 	}
1077 
1078 	val = WPA_GET_BE16(resp);
1079 	if (val == 0x63c0 || val == 0x6983) {
1080 		wpa_printf(MSG_DEBUG, "SCARD: PIN has been blocked");
1081 		return 0;
1082 	}
1083 
1084 	if (val >= 0x63c0 && val <= 0x63cf)
1085 		return val & 0x000f;
1086 
1087 	wpa_printf(MSG_DEBUG, "SCARD: Unexpected PIN retry counter response "
1088 		   "value 0x%x", val);
1089 	return 0;
1090 }
1091 
1092 
1093 /**
1094  * scard_get_imsi - Read IMSI from SIM/USIM card
1095  * @scard: Pointer to private data from scard_init()
1096  * @imsi: Buffer for IMSI
1097  * @len: Length of imsi buffer; set to IMSI length on success
1098  * Returns: 0 on success, -1 if IMSI file cannot be selected, -2 if IMSI file
1099  * selection returns invalid result code, -3 if parsing FSP template file fails
1100  * (USIM only), -4 if IMSI does not fit in the provided imsi buffer (len is set
1101  * to needed length), -5 if reading IMSI file fails.
1102  *
1103  * This function can be used to read IMSI from the SIM/USIM card. If the IMSI
1104  * file is PIN protected, scard_set_pin() must have been used to set the
1105  * correct PIN code before calling scard_get_imsi().
1106  */
1107 int scard_get_imsi(struct scard_data *scard, char *imsi, size_t *len)
1108 {
1109 	unsigned char buf[100];
1110 	size_t blen, imsilen, i;
1111 	char *pos;
1112 
1113 	wpa_printf(MSG_DEBUG, "SCARD: reading IMSI from (GSM) EF-IMSI");
1114 	blen = sizeof(buf);
1115 	if (scard_select_file(scard, SCARD_FILE_GSM_EF_IMSI, buf, &blen))
1116 		return -1;
1117 	if (blen < 4) {
1118 		wpa_printf(MSG_WARNING, "SCARD: too short (GSM) EF-IMSI "
1119 			   "header (len=%ld)", (long) blen);
1120 		return -2;
1121 	}
1122 
1123 	if (scard->sim_type == SCARD_GSM_SIM) {
1124 		blen = WPA_GET_BE16(&buf[2]);
1125 	} else {
1126 		int file_size;
1127 		if (scard_parse_fsp_templ(buf, blen, NULL, &file_size))
1128 			return -3;
1129 		blen = file_size;
1130 	}
1131 	if (blen < 2 || blen > sizeof(buf)) {
1132 		wpa_printf(MSG_DEBUG, "SCARD: invalid IMSI file length=%ld",
1133 			   (long) blen);
1134 		return -3;
1135 	}
1136 
1137 	imsilen = (blen - 2) * 2 + 1;
1138 	wpa_printf(MSG_DEBUG, "SCARD: IMSI file length=%ld imsilen=%ld",
1139 		   (long) blen, (long) imsilen);
1140 	if (blen < 2 || imsilen > *len) {
1141 		*len = imsilen;
1142 		return -4;
1143 	}
1144 
1145 	if (scard_read_file(scard, buf, blen))
1146 		return -5;
1147 
1148 	pos = imsi;
1149 	*pos++ = '0' + (buf[1] >> 4 & 0x0f);
1150 	for (i = 2; i < blen; i++) {
1151 		unsigned char digit;
1152 
1153 		digit = buf[i] & 0x0f;
1154 		if (digit < 10)
1155 			*pos++ = '0' + digit;
1156 		else
1157 			imsilen--;
1158 
1159 		digit = buf[i] >> 4 & 0x0f;
1160 		if (digit < 10)
1161 			*pos++ = '0' + digit;
1162 		else
1163 			imsilen--;
1164 	}
1165 	*len = imsilen;
1166 
1167 	return 0;
1168 }
1169 
1170 
1171 /**
1172  * scard_get_mnc_len - Read length of MNC in the IMSI from SIM/USIM card
1173  * @scard: Pointer to private data from scard_init()
1174  * Returns: length (>0) on success, -1 if administrative data file cannot be
1175  * selected, -2 if administrative data file selection returns invalid result
1176  * code, -3 if parsing FSP template file fails (USIM only), -4 if length of
1177  * the file is unexpected, -5 if reading file fails, -6 if MNC length is not
1178  * in range (i.e. 2 or 3), -7 if MNC length is not available.
1179  *
1180  */
1181 int scard_get_mnc_len(struct scard_data *scard)
1182 {
1183 	unsigned char buf[100];
1184 	size_t blen;
1185 	int file_size;
1186 
1187 	wpa_printf(MSG_DEBUG, "SCARD: reading MNC len from (GSM) EF-AD");
1188 	blen = sizeof(buf);
1189 	if (scard_select_file(scard, SCARD_FILE_GSM_EF_AD, buf, &blen))
1190 		return -1;
1191 	if (blen < 4) {
1192 		wpa_printf(MSG_WARNING, "SCARD: too short (GSM) EF-AD "
1193 			   "header (len=%ld)", (long) blen);
1194 		return -2;
1195 	}
1196 
1197 	if (scard->sim_type == SCARD_GSM_SIM) {
1198 		file_size = WPA_GET_BE16(&buf[2]);
1199 	} else {
1200 		if (scard_parse_fsp_templ(buf, blen, NULL, &file_size))
1201 			return -3;
1202 	}
1203 	if (file_size == 3) {
1204 		wpa_printf(MSG_DEBUG, "SCARD: MNC length not available");
1205 		return -7;
1206 	}
1207 	if (file_size < 4 || file_size > (int) sizeof(buf)) {
1208 		wpa_printf(MSG_DEBUG, "SCARD: invalid file length=%ld",
1209 			   (long) file_size);
1210 		return -4;
1211 	}
1212 
1213 	if (scard_read_file(scard, buf, file_size))
1214 		return -5;
1215 	buf[3] = buf[3] & 0x0f; /* upper nibble reserved for future use  */
1216 	if (buf[3] < 2 || buf[3] > 3) {
1217 		wpa_printf(MSG_DEBUG, "SCARD: invalid MNC length=%ld",
1218 			   (long) buf[3]);
1219 		return -6;
1220 	}
1221 	wpa_printf(MSG_DEBUG, "SCARD: MNC length=%ld", (long) buf[3]);
1222 	return buf[3];
1223 }
1224 
1225 
1226 /**
1227  * scard_gsm_auth - Run GSM authentication command on SIM card
1228  * @scard: Pointer to private data from scard_init()
1229  * @_rand: 16-byte RAND value from HLR/AuC
1230  * @sres: 4-byte buffer for SRES
1231  * @kc: 8-byte buffer for Kc
1232  * Returns: 0 on success, -1 if SIM/USIM connection has not been initialized,
1233  * -2 if authentication command execution fails, -3 if unknown response code
1234  * for authentication command is received, -4 if reading of response fails,
1235  * -5 if if response data is of unexpected length
1236  *
1237  * This function performs GSM authentication using SIM/USIM card and the
1238  * provided RAND value from HLR/AuC. If authentication command can be completed
1239  * successfully, SRES and Kc values will be written into sres and kc buffers.
1240  */
1241 int scard_gsm_auth(struct scard_data *scard, const unsigned char *_rand,
1242 		   unsigned char *sres, unsigned char *kc)
1243 {
1244 	unsigned char cmd[5 + 1 + 16] = { SIM_CMD_RUN_GSM_ALG };
1245 	int cmdlen;
1246 	unsigned char get_resp[5] = { SIM_CMD_GET_RESPONSE };
1247 	unsigned char resp[3], buf[12 + 3 + 2];
1248 	size_t len;
1249 	long ret;
1250 
1251 	if (scard == NULL)
1252 		return -1;
1253 
1254 	wpa_hexdump(MSG_DEBUG, "SCARD: GSM auth - RAND", _rand, 16);
1255 	if (scard->sim_type == SCARD_GSM_SIM) {
1256 		cmdlen = 5 + 16;
1257 		os_memcpy(cmd + 5, _rand, 16);
1258 	} else {
1259 		cmdlen = 5 + 1 + 16;
1260 		cmd[0] = USIM_CLA;
1261 		cmd[3] = 0x80;
1262 		cmd[4] = 17;
1263 		cmd[5] = 16;
1264 		os_memcpy(cmd + 6, _rand, 16);
1265 		get_resp[0] = USIM_CLA;
1266 	}
1267 	len = sizeof(resp);
1268 	ret = scard_transmit(scard, cmd, cmdlen, resp, &len);
1269 	if (ret != SCARD_S_SUCCESS)
1270 		return -2;
1271 
1272 	if ((scard->sim_type == SCARD_GSM_SIM &&
1273 	     (len != 2 || resp[0] != 0x9f || resp[1] != 0x0c)) ||
1274 	    (scard->sim_type == SCARD_USIM &&
1275 	     (len != 2 || resp[0] != 0x61 || resp[1] != 0x0e))) {
1276 		wpa_printf(MSG_WARNING, "SCARD: unexpected response for GSM "
1277 			   "auth request (len=%ld resp=%02x %02x)",
1278 			   (long) len, resp[0], resp[1]);
1279 		return -3;
1280 	}
1281 	get_resp[4] = resp[1];
1282 
1283 	len = sizeof(buf);
1284 	ret = scard_transmit(scard, get_resp, sizeof(get_resp), buf, &len);
1285 	if (ret != SCARD_S_SUCCESS)
1286 		return -4;
1287 
1288 	if (scard->sim_type == SCARD_GSM_SIM) {
1289 		if (len != 4 + 8 + 2) {
1290 			wpa_printf(MSG_WARNING, "SCARD: unexpected data "
1291 				   "length for GSM auth (len=%ld, expected 14)",
1292 				   (long) len);
1293 			return -5;
1294 		}
1295 		os_memcpy(sres, buf, 4);
1296 		os_memcpy(kc, buf + 4, 8);
1297 	} else {
1298 		if (len != 1 + 4 + 1 + 8 + 2) {
1299 			wpa_printf(MSG_WARNING, "SCARD: unexpected data "
1300 				   "length for USIM auth (len=%ld, "
1301 				   "expected 16)", (long) len);
1302 			return -5;
1303 		}
1304 		if (buf[0] != 4 || buf[5] != 8) {
1305 			wpa_printf(MSG_WARNING, "SCARD: unexpected SREC/Kc "
1306 				   "length (%d %d, expected 4 8)",
1307 				   buf[0], buf[5]);
1308 		}
1309 		os_memcpy(sres, buf + 1, 4);
1310 		os_memcpy(kc, buf + 6, 8);
1311 	}
1312 
1313 	wpa_hexdump(MSG_DEBUG, "SCARD: GSM auth - SRES", sres, 4);
1314 	wpa_hexdump(MSG_DEBUG, "SCARD: GSM auth - Kc", kc, 8);
1315 
1316 	return 0;
1317 }
1318 
1319 
1320 /**
1321  * scard_umts_auth - Run UMTS authentication command on USIM card
1322  * @scard: Pointer to private data from scard_init()
1323  * @_rand: 16-byte RAND value from HLR/AuC
1324  * @autn: 16-byte AUTN value from HLR/AuC
1325  * @res: 16-byte buffer for RES
1326  * @res_len: Variable that will be set to RES length
1327  * @ik: 16-byte buffer for IK
1328  * @ck: 16-byte buffer for CK
1329  * @auts: 14-byte buffer for AUTS
1330  * Returns: 0 on success, -1 on failure, or -2 if USIM reports synchronization
1331  * failure
1332  *
1333  * This function performs AKA authentication using USIM card and the provided
1334  * RAND and AUTN values from HLR/AuC. If authentication command can be
1335  * completed successfully, RES, IK, and CK values will be written into provided
1336  * buffers and res_len is set to length of received RES value. If USIM reports
1337  * synchronization failure, the received AUTS value will be written into auts
1338  * buffer. In this case, RES, IK, and CK are not valid.
1339  */
1340 int scard_umts_auth(struct scard_data *scard, const unsigned char *_rand,
1341 		    const unsigned char *autn,
1342 		    unsigned char *res, size_t *res_len,
1343 		    unsigned char *ik, unsigned char *ck, unsigned char *auts)
1344 {
1345 	unsigned char cmd[5 + 1 + AKA_RAND_LEN + 1 + AKA_AUTN_LEN] =
1346 		{ USIM_CMD_RUN_UMTS_ALG };
1347 	unsigned char get_resp[5] = { USIM_CMD_GET_RESPONSE };
1348 	unsigned char resp[3], buf[64], *pos, *end;
1349 	size_t len;
1350 	long ret;
1351 
1352 	if (scard == NULL)
1353 		return -1;
1354 
1355 	if (scard->sim_type == SCARD_GSM_SIM) {
1356 		wpa_printf(MSG_ERROR, "SCARD: Non-USIM card - cannot do UMTS "
1357 			   "auth");
1358 		return -1;
1359 	}
1360 
1361 	wpa_hexdump(MSG_DEBUG, "SCARD: UMTS auth - RAND", _rand, AKA_RAND_LEN);
1362 	wpa_hexdump(MSG_DEBUG, "SCARD: UMTS auth - AUTN", autn, AKA_AUTN_LEN);
1363 	cmd[5] = AKA_RAND_LEN;
1364 	os_memcpy(cmd + 6, _rand, AKA_RAND_LEN);
1365 	cmd[6 + AKA_RAND_LEN] = AKA_AUTN_LEN;
1366 	os_memcpy(cmd + 6 + AKA_RAND_LEN + 1, autn, AKA_AUTN_LEN);
1367 
1368 	len = sizeof(resp);
1369 	ret = scard_transmit(scard, cmd, sizeof(cmd), resp, &len);
1370 	if (ret != SCARD_S_SUCCESS)
1371 		return -1;
1372 
1373 	if (len <= sizeof(resp))
1374 		wpa_hexdump(MSG_DEBUG, "SCARD: UMTS alg response", resp, len);
1375 
1376 	if (len == 2 && resp[0] == 0x98 && resp[1] == 0x62) {
1377 		wpa_printf(MSG_WARNING, "SCARD: UMTS auth failed - "
1378 			   "MAC != XMAC");
1379 		return -1;
1380 	} else if (len != 2 || resp[0] != 0x61) {
1381 		wpa_printf(MSG_WARNING, "SCARD: unexpected response for UMTS "
1382 			   "auth request (len=%ld resp=%02x %02x)",
1383 			   (long) len, resp[0], resp[1]);
1384 		return -1;
1385 	}
1386 	get_resp[4] = resp[1];
1387 
1388 	len = sizeof(buf);
1389 	ret = scard_transmit(scard, get_resp, sizeof(get_resp), buf, &len);
1390 	if (ret != SCARD_S_SUCCESS || len > sizeof(buf))
1391 		return -1;
1392 
1393 	wpa_hexdump(MSG_DEBUG, "SCARD: UMTS get response result", buf, len);
1394 	if (len >= 2 + AKA_AUTS_LEN && buf[0] == 0xdc &&
1395 	    buf[1] == AKA_AUTS_LEN) {
1396 		wpa_printf(MSG_DEBUG, "SCARD: UMTS Synchronization-Failure");
1397 		os_memcpy(auts, buf + 2, AKA_AUTS_LEN);
1398 		wpa_hexdump(MSG_DEBUG, "SCARD: AUTS", auts, AKA_AUTS_LEN);
1399 		return -2;
1400 	} else if (len >= 6 + IK_LEN + CK_LEN && buf[0] == 0xdb) {
1401 		pos = buf + 1;
1402 		end = buf + len;
1403 
1404 		/* RES */
1405 		if (pos[0] > RES_MAX_LEN || pos[0] > end - pos) {
1406 			wpa_printf(MSG_DEBUG, "SCARD: Invalid RES");
1407 			return -1;
1408 		}
1409 		*res_len = *pos++;
1410 		os_memcpy(res, pos, *res_len);
1411 		pos += *res_len;
1412 		wpa_hexdump(MSG_DEBUG, "SCARD: RES", res, *res_len);
1413 
1414 		/* CK */
1415 		if (pos[0] != CK_LEN || CK_LEN > end - pos) {
1416 			wpa_printf(MSG_DEBUG, "SCARD: Invalid CK");
1417 			return -1;
1418 		}
1419 		pos++;
1420 		os_memcpy(ck, pos, CK_LEN);
1421 		pos += CK_LEN;
1422 		wpa_hexdump(MSG_DEBUG, "SCARD: CK", ck, CK_LEN);
1423 
1424 		/* IK */
1425 		if (pos[0] != IK_LEN || IK_LEN > end - pos) {
1426 			wpa_printf(MSG_DEBUG, "SCARD: Invalid IK");
1427 			return -1;
1428 		}
1429 		pos++;
1430 		os_memcpy(ik, pos, IK_LEN);
1431 		pos += IK_LEN;
1432 		wpa_hexdump(MSG_DEBUG, "SCARD: IK", ik, IK_LEN);
1433 
1434 		if (end > pos) {
1435 			wpa_hexdump(MSG_DEBUG,
1436 				    "SCARD: Ignore extra data in end",
1437 				    pos, end - pos);
1438 		}
1439 
1440 		return 0;
1441 	}
1442 
1443 	wpa_printf(MSG_DEBUG, "SCARD: Unrecognized response");
1444 	return -1;
1445 }
1446 
1447 
1448 int scard_supports_umts(struct scard_data *scard)
1449 {
1450 	return scard->sim_type == SCARD_USIM;
1451 }
1452