123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434 |
- /*
- * WPA Supplicant / PC/SC smartcard interface for USIM, GSM SIM
- * Copyright (c) 2004-2007, 2012, Jouni Malinen <j@w1.fi>
- *
- * This software may be distributed under the terms of the BSD license.
- * See README for more details.
- *
- * This file implements wrapper functions for accessing GSM SIM and 3GPP USIM
- * cards through PC/SC smartcard library. These functions are used to implement
- * authentication routines for EAP-SIM and EAP-AKA.
- */
- #include "includes.h"
- #include <winscard.h>
- #include "common.h"
- #include "pcsc_funcs.h"
- /* See ETSI GSM 11.11 and ETSI TS 102 221 for details.
- * SIM commands:
- * Command APDU: CLA INS P1 P2 P3 Data
- * CLA (class of instruction): A0 for GSM, 00 for USIM
- * INS (instruction)
- * P1 P2 P3 (parameters, P3 = length of Data)
- * Response APDU: Data SW1 SW2
- * SW1 SW2 (Status words)
- * Commands (INS P1 P2 P3):
- * SELECT: A4 00 00 02 <file_id, 2 bytes>
- * GET RESPONSE: C0 00 00 <len>
- * RUN GSM ALG: 88 00 00 00 <RAND len = 10>
- * RUN UMTS ALG: 88 00 81 <len=0x22> data: 0x10 | RAND | 0x10 | AUTN
- * P1 = ID of alg in card
- * P2 = ID of secret key
- * READ BINARY: B0 <offset high> <offset low> <len>
- * READ RECORD: B2 <record number> <mode> <len>
- * P2 (mode) = '02' (next record), '03' (previous record),
- * '04' (absolute mode)
- * VERIFY CHV: 20 00 <CHV number> 08
- * CHANGE CHV: 24 00 <CHV number> 10
- * DISABLE CHV: 26 00 01 08
- * ENABLE CHV: 28 00 01 08
- * UNBLOCK CHV: 2C 00 <00=CHV1, 02=CHV2> 10
- * SLEEP: FA 00 00 00
- */
- /* GSM SIM commands */
- #define SIM_CMD_SELECT 0xa0, 0xa4, 0x00, 0x00, 0x02
- #define SIM_CMD_RUN_GSM_ALG 0xa0, 0x88, 0x00, 0x00, 0x10
- #define SIM_CMD_GET_RESPONSE 0xa0, 0xc0, 0x00, 0x00
- #define SIM_CMD_READ_BIN 0xa0, 0xb0, 0x00, 0x00
- #define SIM_CMD_READ_RECORD 0xa0, 0xb2, 0x00, 0x00
- #define SIM_CMD_VERIFY_CHV1 0xa0, 0x20, 0x00, 0x01, 0x08
- /* USIM commands */
- #define USIM_CLA 0x00
- #define USIM_CMD_RUN_UMTS_ALG 0x00, 0x88, 0x00, 0x81, 0x22
- #define USIM_CMD_GET_RESPONSE 0x00, 0xc0, 0x00, 0x00
- #define SIM_RECORD_MODE_ABSOLUTE 0x04
- #define USIM_FSP_TEMPL_TAG 0x62
- #define USIM_TLV_FILE_DESC 0x82
- #define USIM_TLV_FILE_ID 0x83
- #define USIM_TLV_DF_NAME 0x84
- #define USIM_TLV_PROPR_INFO 0xA5
- #define USIM_TLV_LIFE_CYCLE_STATUS 0x8A
- #define USIM_TLV_FILE_SIZE 0x80
- #define USIM_TLV_TOTAL_FILE_SIZE 0x81
- #define USIM_TLV_PIN_STATUS_TEMPLATE 0xC6
- #define USIM_TLV_SHORT_FILE_ID 0x88
- #define USIM_TLV_SECURITY_ATTR_8B 0x8B
- #define USIM_TLV_SECURITY_ATTR_8C 0x8C
- #define USIM_TLV_SECURITY_ATTR_AB 0xAB
- #define USIM_PS_DO_TAG 0x90
- #define AKA_RAND_LEN 16
- #define AKA_AUTN_LEN 16
- #define AKA_AUTS_LEN 14
- #define RES_MAX_LEN 16
- #define IK_LEN 16
- #define CK_LEN 16
- /* GSM files
- * File type in first octet:
- * 3F = Master File
- * 7F = Dedicated File
- * 2F = Elementary File under the Master File
- * 6F = Elementary File under a Dedicated File
- */
- #define SCARD_FILE_MF 0x3F00
- #define SCARD_FILE_GSM_DF 0x7F20
- #define SCARD_FILE_UMTS_DF 0x7F50
- #define SCARD_FILE_GSM_EF_IMSI 0x6F07
- #define SCARD_FILE_GSM_EF_AD 0x6FAD
- #define SCARD_FILE_EF_DIR 0x2F00
- #define SCARD_FILE_EF_ICCID 0x2FE2
- #define SCARD_FILE_EF_CK 0x6FE1
- #define SCARD_FILE_EF_IK 0x6FE2
- #define SCARD_CHV1_OFFSET 13
- #define SCARD_CHV1_FLAG 0x80
- typedef enum { SCARD_GSM_SIM, SCARD_USIM } sim_types;
- struct scard_data {
- SCARDCONTEXT ctx;
- SCARDHANDLE card;
- DWORD protocol;
- sim_types sim_type;
- int pin1_required;
- };
- #ifdef __MINGW32_VERSION
- /* MinGW does not yet support WinScard, so load the needed functions
- * dynamically from winscard.dll for now. */
- static HINSTANCE dll = NULL; /* winscard.dll */
- static const SCARD_IO_REQUEST *dll_g_rgSCardT0Pci, *dll_g_rgSCardT1Pci;
- #undef SCARD_PCI_T0
- #define SCARD_PCI_T0 (dll_g_rgSCardT0Pci)
- #undef SCARD_PCI_T1
- #define SCARD_PCI_T1 (dll_g_rgSCardT1Pci)
- static WINSCARDAPI LONG WINAPI
- (*dll_SCardEstablishContext)(IN DWORD dwScope,
- IN LPCVOID pvReserved1,
- IN LPCVOID pvReserved2,
- OUT LPSCARDCONTEXT phContext);
- #define SCardEstablishContext dll_SCardEstablishContext
- static long (*dll_SCardReleaseContext)(long hContext);
- #define SCardReleaseContext dll_SCardReleaseContext
- static WINSCARDAPI LONG WINAPI
- (*dll_SCardListReadersA)(IN SCARDCONTEXT hContext,
- IN LPCSTR mszGroups,
- OUT LPSTR mszReaders,
- IN OUT LPDWORD pcchReaders);
- #undef SCardListReaders
- #define SCardListReaders dll_SCardListReadersA
- static WINSCARDAPI LONG WINAPI
- (*dll_SCardConnectA)(IN SCARDCONTEXT hContext,
- IN LPCSTR szReader,
- IN DWORD dwShareMode,
- IN DWORD dwPreferredProtocols,
- OUT LPSCARDHANDLE phCard,
- OUT LPDWORD pdwActiveProtocol);
- #undef SCardConnect
- #define SCardConnect dll_SCardConnectA
- static WINSCARDAPI LONG WINAPI
- (*dll_SCardDisconnect)(IN SCARDHANDLE hCard,
- IN DWORD dwDisposition);
- #define SCardDisconnect dll_SCardDisconnect
- static WINSCARDAPI LONG WINAPI
- (*dll_SCardTransmit)(IN SCARDHANDLE hCard,
- IN LPCSCARD_IO_REQUEST pioSendPci,
- IN LPCBYTE pbSendBuffer,
- IN DWORD cbSendLength,
- IN OUT LPSCARD_IO_REQUEST pioRecvPci,
- OUT LPBYTE pbRecvBuffer,
- IN OUT LPDWORD pcbRecvLength);
- #define SCardTransmit dll_SCardTransmit
- static WINSCARDAPI LONG WINAPI
- (*dll_SCardBeginTransaction)(IN SCARDHANDLE hCard);
- #define SCardBeginTransaction dll_SCardBeginTransaction
- static WINSCARDAPI LONG WINAPI
- (*dll_SCardEndTransaction)(IN SCARDHANDLE hCard, IN DWORD dwDisposition);
- #define SCardEndTransaction dll_SCardEndTransaction
- static int mingw_load_symbols(void)
- {
- char *sym;
- if (dll)
- return 0;
- dll = LoadLibrary("winscard");
- if (dll == NULL) {
- wpa_printf(MSG_DEBUG, "WinSCard: Could not load winscard.dll "
- "library");
- return -1;
- }
- #define LOADSYM(s) \
- sym = #s; \
- dll_ ## s = (void *) GetProcAddress(dll, sym); \
- if (dll_ ## s == NULL) \
- goto fail;
- LOADSYM(SCardEstablishContext);
- LOADSYM(SCardReleaseContext);
- LOADSYM(SCardListReadersA);
- LOADSYM(SCardConnectA);
- LOADSYM(SCardDisconnect);
- LOADSYM(SCardTransmit);
- LOADSYM(SCardBeginTransaction);
- LOADSYM(SCardEndTransaction);
- LOADSYM(g_rgSCardT0Pci);
- LOADSYM(g_rgSCardT1Pci);
- #undef LOADSYM
- return 0;
- fail:
- wpa_printf(MSG_DEBUG, "WinSCard: Could not get address for %s from "
- "winscard.dll", sym);
- FreeLibrary(dll);
- dll = NULL;
- return -1;
- }
- static void mingw_unload_symbols(void)
- {
- if (dll == NULL)
- return;
- FreeLibrary(dll);
- dll = NULL;
- }
- #else /* __MINGW32_VERSION */
- #define mingw_load_symbols() 0
- #define mingw_unload_symbols() do { } while (0)
- #endif /* __MINGW32_VERSION */
- static int _scard_select_file(struct scard_data *scard, unsigned short file_id,
- unsigned char *buf, size_t *buf_len,
- sim_types sim_type, unsigned char *aid,
- size_t aidlen);
- static int scard_select_file(struct scard_data *scard, unsigned short file_id,
- unsigned char *buf, size_t *buf_len);
- static int scard_verify_pin(struct scard_data *scard, const char *pin);
- static int scard_get_record_len(struct scard_data *scard,
- unsigned char recnum, unsigned char mode);
- static int scard_read_record(struct scard_data *scard,
- unsigned char *data, size_t len,
- unsigned char recnum, unsigned char mode);
- static int scard_parse_fsp_templ(unsigned char *buf, size_t buf_len,
- int *ps_do, int *file_len)
- {
- unsigned char *pos, *end;
- if (ps_do)
- *ps_do = -1;
- if (file_len)
- *file_len = -1;
- pos = buf;
- end = pos + buf_len;
- if (*pos != USIM_FSP_TEMPL_TAG) {
- wpa_printf(MSG_DEBUG, "SCARD: file header did not "
- "start with FSP template tag");
- return -1;
- }
- pos++;
- if (pos >= end)
- return -1;
- if ((pos + pos[0]) < end)
- end = pos + 1 + pos[0];
- pos++;
- wpa_hexdump(MSG_DEBUG, "SCARD: file header FSP template",
- pos, end - pos);
- while (end - pos >= 2) {
- unsigned char type, len;
- type = pos[0];
- len = pos[1];
- wpa_printf(MSG_MSGDUMP, "SCARD: file header TLV 0x%02x len=%d",
- type, len);
- pos += 2;
- if (len > (unsigned int) (end - pos))
- break;
- switch (type) {
- case USIM_TLV_FILE_DESC:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: File Descriptor TLV",
- pos, len);
- break;
- case USIM_TLV_FILE_ID:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: File Identifier TLV",
- pos, len);
- break;
- case USIM_TLV_DF_NAME:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: DF name (AID) TLV",
- pos, len);
- break;
- case USIM_TLV_PROPR_INFO:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: Proprietary "
- "information TLV", pos, len);
- break;
- case USIM_TLV_LIFE_CYCLE_STATUS:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: Life Cycle Status "
- "Integer TLV", pos, len);
- break;
- case USIM_TLV_FILE_SIZE:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: File size TLV",
- pos, len);
- if ((len == 1 || len == 2) && file_len) {
- if (len == 1)
- *file_len = (int) pos[0];
- else
- *file_len = WPA_GET_BE16(pos);
- wpa_printf(MSG_DEBUG, "SCARD: file_size=%d",
- *file_len);
- }
- break;
- case USIM_TLV_TOTAL_FILE_SIZE:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: Total file size TLV",
- pos, len);
- break;
- case USIM_TLV_PIN_STATUS_TEMPLATE:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: PIN Status Template "
- "DO TLV", pos, len);
- if (len >= 2 && pos[0] == USIM_PS_DO_TAG &&
- pos[1] >= 1 && ps_do) {
- wpa_printf(MSG_DEBUG, "SCARD: PS_DO=0x%02x",
- pos[2]);
- *ps_do = (int) pos[2];
- }
- break;
- case USIM_TLV_SHORT_FILE_ID:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: Short File "
- "Identifier (SFI) TLV", pos, len);
- break;
- case USIM_TLV_SECURITY_ATTR_8B:
- case USIM_TLV_SECURITY_ATTR_8C:
- case USIM_TLV_SECURITY_ATTR_AB:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: Security attribute "
- "TLV", pos, len);
- break;
- default:
- wpa_hexdump(MSG_MSGDUMP, "SCARD: Unrecognized TLV",
- pos, len);
- break;
- }
- pos += len;
- if (pos == end)
- return 0;
- }
- return -1;
- }
- static int scard_pin_needed(struct scard_data *scard,
- unsigned char *hdr, size_t hlen)
- {
- if (scard->sim_type == SCARD_GSM_SIM) {
- if (hlen > SCARD_CHV1_OFFSET &&
- !(hdr[SCARD_CHV1_OFFSET] & SCARD_CHV1_FLAG))
- return 1;
- return 0;
- }
- if (scard->sim_type == SCARD_USIM) {
- int ps_do;
- if (scard_parse_fsp_templ(hdr, hlen, &ps_do, NULL))
- return -1;
- /* TODO: there could be more than one PS_DO entry because of
- * multiple PINs in key reference.. */
- if (ps_do > 0 && (ps_do & 0x80))
- return 1;
- return 0;
- }
- return -1;
- }
- static int scard_get_aid(struct scard_data *scard, unsigned char *aid,
- size_t maxlen)
- {
- int rlen, rec;
- struct efdir {
- unsigned char appl_template_tag; /* 0x61 */
- unsigned char appl_template_len;
- unsigned char appl_id_tag; /* 0x4f */
- unsigned char aid_len;
- unsigned char rid[5];
- unsigned char appl_code[2]; /* 0x1002 for 3G USIM */
- } *efdir;
- unsigned char buf[127], *aid_pos;
- size_t blen;
- unsigned int aid_len = 0;
- efdir = (struct efdir *) buf;
- aid_pos = &buf[4];
- blen = sizeof(buf);
- if (scard_select_file(scard, SCARD_FILE_EF_DIR, buf, &blen)) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to read EF_DIR");
- return -1;
- }
- wpa_hexdump(MSG_DEBUG, "SCARD: EF_DIR select", buf, blen);
- for (rec = 1; rec < 10; rec++) {
- rlen = scard_get_record_len(scard, rec,
- SIM_RECORD_MODE_ABSOLUTE);
- if (rlen < 0) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to get EF_DIR "
- "record length");
- return -1;
- }
- blen = sizeof(buf);
- if (rlen > (int) blen) {
- wpa_printf(MSG_DEBUG, "SCARD: Too long EF_DIR record");
- return -1;
- }
- if (scard_read_record(scard, buf, rlen, rec,
- SIM_RECORD_MODE_ABSOLUTE) < 0) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to read "
- "EF_DIR record %d", rec);
- return -1;
- }
- wpa_hexdump(MSG_DEBUG, "SCARD: EF_DIR record", buf, rlen);
- if (efdir->appl_template_tag != 0x61) {
- wpa_printf(MSG_DEBUG, "SCARD: Unexpected application "
- "template tag 0x%x",
- efdir->appl_template_tag);
- continue;
- }
- if (efdir->appl_template_len > rlen - 2) {
- wpa_printf(MSG_DEBUG, "SCARD: Too long application "
- "template (len=%d rlen=%d)",
- efdir->appl_template_len, rlen);
- continue;
- }
- if (efdir->appl_id_tag != 0x4f) {
- wpa_printf(MSG_DEBUG, "SCARD: Unexpected application "
- "identifier tag 0x%x", efdir->appl_id_tag);
- continue;
- }
- aid_len = efdir->aid_len;
- if (aid_len < 1 || aid_len > 16) {
- wpa_printf(MSG_DEBUG, "SCARD: Invalid AID length %u",
- aid_len);
- continue;
- }
- wpa_hexdump(MSG_DEBUG, "SCARD: AID from EF_DIR record",
- aid_pos, aid_len);
- if (efdir->appl_code[0] == 0x10 &&
- efdir->appl_code[1] == 0x02) {
- wpa_printf(MSG_DEBUG, "SCARD: 3G USIM app found from "
- "EF_DIR record %d", rec);
- break;
- }
- }
- if (rec >= 10) {
- wpa_printf(MSG_DEBUG, "SCARD: 3G USIM app not found "
- "from EF_DIR records");
- return -1;
- }
- if (aid_len > maxlen) {
- wpa_printf(MSG_DEBUG, "SCARD: Too long AID");
- return -1;
- }
- os_memcpy(aid, aid_pos, aid_len);
- return aid_len;
- }
- /**
- * scard_init - Initialize SIM/USIM connection using PC/SC
- * @reader: Reader name prefix to search for
- * Returns: Pointer to private data structure, or %NULL on failure
- *
- * This function is used to initialize SIM/USIM connection. PC/SC is used to
- * open connection to the SIM/USIM card. In addition, local flag is set if a
- * PIN is needed to access some of the card functions. Once the connection is
- * not needed anymore, scard_deinit() can be used to close it.
- */
- struct scard_data * scard_init(const char *reader)
- {
- long ret;
- unsigned long len, pos;
- struct scard_data *scard;
- #ifdef CONFIG_NATIVE_WINDOWS
- TCHAR *readers = NULL;
- #else /* CONFIG_NATIVE_WINDOWS */
- char *readers = NULL;
- #endif /* CONFIG_NATIVE_WINDOWS */
- unsigned char buf[100];
- size_t blen;
- int transaction = 0;
- int pin_needed;
- wpa_printf(MSG_DEBUG, "SCARD: initializing smart card interface");
- if (mingw_load_symbols())
- return NULL;
- scard = os_zalloc(sizeof(*scard));
- if (scard == NULL)
- return NULL;
- ret = SCardEstablishContext(SCARD_SCOPE_SYSTEM, NULL, NULL,
- &scard->ctx);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "SCARD: Could not establish smart card "
- "context (err=%ld)", ret);
- goto failed;
- }
- ret = SCardListReaders(scard->ctx, NULL, NULL, &len);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "SCARD: SCardListReaders failed "
- "(err=%ld)", ret);
- goto failed;
- }
- #ifdef UNICODE
- len *= 2;
- #endif /* UNICODE */
- readers = os_malloc(len);
- if (readers == NULL) {
- wpa_printf(MSG_INFO, "SCARD: malloc failed\n");
- goto failed;
- }
- ret = SCardListReaders(scard->ctx, NULL, readers, &len);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "SCARD: SCardListReaders failed(2) "
- "(err=%ld)", ret);
- goto failed;
- }
- if (len < 3) {
- wpa_printf(MSG_WARNING, "SCARD: No smart card readers "
- "available.");
- goto failed;
- }
- wpa_hexdump_ascii(MSG_DEBUG, "SCARD: Readers", (u8 *) readers, len);
- /*
- * readers is a list of available readers. The last entry is terminated
- * with double null.
- */
- pos = 0;
- #ifdef UNICODE
- /* TODO */
- #else /* UNICODE */
- while (pos < len) {
- if (reader == NULL ||
- os_strncmp(&readers[pos], reader, os_strlen(reader)) == 0)
- break;
- while (pos < len && readers[pos])
- pos++;
- pos++; /* skip separating null */
- if (pos < len && readers[pos] == '\0')
- pos = len; /* double null terminates list */
- }
- #endif /* UNICODE */
- if (pos >= len) {
- wpa_printf(MSG_WARNING, "SCARD: No reader with prefix '%s' "
- "found", reader);
- goto failed;
- }
- #ifdef UNICODE
- wpa_printf(MSG_DEBUG, "SCARD: Selected reader='%S'", &readers[pos]);
- #else /* UNICODE */
- wpa_printf(MSG_DEBUG, "SCARD: Selected reader='%s'", &readers[pos]);
- #endif /* UNICODE */
- ret = SCardConnect(scard->ctx, &readers[pos], SCARD_SHARE_SHARED,
- SCARD_PROTOCOL_T0 | SCARD_PROTOCOL_T1,
- &scard->card, &scard->protocol);
- if (ret != SCARD_S_SUCCESS) {
- if (ret == (long) SCARD_E_NO_SMARTCARD)
- wpa_printf(MSG_INFO, "No smart card inserted.");
- else
- wpa_printf(MSG_WARNING, "SCardConnect err=%lx", ret);
- goto failed;
- }
- os_free(readers);
- readers = NULL;
- wpa_printf(MSG_DEBUG, "SCARD: card=0x%x active_protocol=%lu (%s)",
- (unsigned int) scard->card, scard->protocol,
- scard->protocol == SCARD_PROTOCOL_T0 ? "T0" : "T1");
- ret = SCardBeginTransaction(scard->card);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "SCARD: Could not begin transaction: "
- "0x%x", (unsigned int) ret);
- goto failed;
- }
- transaction = 1;
- blen = sizeof(buf);
- wpa_printf(MSG_DEBUG, "SCARD: verifying USIM support");
- if (_scard_select_file(scard, SCARD_FILE_MF, buf, &blen,
- SCARD_USIM, NULL, 0)) {
- wpa_printf(MSG_DEBUG, "SCARD: USIM is not supported. Trying to use GSM SIM");
- scard->sim_type = SCARD_GSM_SIM;
- } else {
- wpa_printf(MSG_DEBUG, "SCARD: USIM is supported");
- scard->sim_type = SCARD_USIM;
- }
- if (scard->sim_type == SCARD_GSM_SIM) {
- blen = sizeof(buf);
- if (scard_select_file(scard, SCARD_FILE_MF, buf, &blen)) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to read MF");
- goto failed;
- }
- blen = sizeof(buf);
- if (scard_select_file(scard, SCARD_FILE_GSM_DF, buf, &blen)) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to read GSM DF");
- goto failed;
- }
- } else {
- unsigned char aid[32];
- int aid_len;
- aid_len = scard_get_aid(scard, aid, sizeof(aid));
- if (aid_len < 0) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to find AID for "
- "3G USIM app - try to use standard 3G RID");
- os_memcpy(aid, "\xa0\x00\x00\x00\x87", 5);
- aid_len = 5;
- }
- wpa_hexdump(MSG_DEBUG, "SCARD: 3G USIM AID", aid, aid_len);
- /* Select based on AID = 3G RID from EF_DIR. This is usually
- * starting with A0 00 00 00 87. */
- blen = sizeof(buf);
- if (_scard_select_file(scard, 0, buf, &blen, scard->sim_type,
- aid, aid_len)) {
- wpa_printf(MSG_INFO, "SCARD: Failed to read 3G USIM "
- "app");
- wpa_hexdump(MSG_INFO, "SCARD: 3G USIM AID",
- aid, aid_len);
- goto failed;
- }
- }
- /* Verify whether CHV1 (PIN1) is needed to access the card. */
- pin_needed = scard_pin_needed(scard, buf, blen);
- if (pin_needed < 0) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to determine whether PIN "
- "is needed");
- goto failed;
- }
- if (pin_needed) {
- scard->pin1_required = 1;
- wpa_printf(MSG_DEBUG, "PIN1 needed for SIM access (retry "
- "counter=%d)", scard_get_pin_retry_counter(scard));
- }
- ret = SCardEndTransaction(scard->card, SCARD_LEAVE_CARD);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "SCARD: Could not end transaction: "
- "0x%x", (unsigned int) ret);
- }
- return scard;
- failed:
- if (transaction)
- SCardEndTransaction(scard->card, SCARD_LEAVE_CARD);
- os_free(readers);
- scard_deinit(scard);
- return NULL;
- }
- /**
- * scard_set_pin - Set PIN (CHV1/PIN1) code for accessing SIM/USIM commands
- * @scard: Pointer to private data from scard_init()
- * @pin: PIN code as an ASCII string (e.g., "1234")
- * Returns: 0 on success, -1 on failure
- */
- int scard_set_pin(struct scard_data *scard, const char *pin)
- {
- if (scard == NULL)
- return -1;
- /* Verify whether CHV1 (PIN1) is needed to access the card. */
- if (scard->pin1_required) {
- if (pin == NULL) {
- wpa_printf(MSG_DEBUG, "No PIN configured for SIM "
- "access");
- return -1;
- }
- if (scard_verify_pin(scard, pin)) {
- wpa_printf(MSG_INFO, "PIN verification failed for "
- "SIM access");
- return -1;
- }
- }
- return 0;
- }
- /**
- * scard_deinit - Deinitialize SIM/USIM connection
- * @scard: Pointer to private data from scard_init()
- *
- * This function closes the SIM/USIM connect opened with scard_init().
- */
- void scard_deinit(struct scard_data *scard)
- {
- long ret;
- if (scard == NULL)
- return;
- wpa_printf(MSG_DEBUG, "SCARD: deinitializing smart card interface");
- if (scard->card) {
- ret = SCardDisconnect(scard->card, SCARD_UNPOWER_CARD);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "SCARD: Failed to disconnect "
- "smart card (err=%ld)", ret);
- }
- }
- if (scard->ctx) {
- ret = SCardReleaseContext(scard->ctx);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "Failed to release smart card "
- "context (err=%ld)", ret);
- }
- }
- os_free(scard);
- mingw_unload_symbols();
- }
- static long scard_transmit(struct scard_data *scard,
- unsigned char *_send, size_t send_len,
- unsigned char *_recv, size_t *recv_len)
- {
- long ret;
- unsigned long rlen;
- wpa_hexdump_key(MSG_DEBUG, "SCARD: scard_transmit: send",
- _send, send_len);
- rlen = *recv_len;
- ret = SCardTransmit(scard->card,
- scard->protocol == SCARD_PROTOCOL_T1 ?
- SCARD_PCI_T1 : SCARD_PCI_T0,
- _send, (unsigned long) send_len,
- NULL, _recv, &rlen);
- *recv_len = rlen;
- if (ret == SCARD_S_SUCCESS) {
- wpa_hexdump(MSG_DEBUG, "SCARD: scard_transmit: recv",
- _recv, rlen);
- } else {
- wpa_printf(MSG_WARNING, "SCARD: SCardTransmit failed "
- "(err=0x%lx)", ret);
- }
- return ret;
- }
- static int _scard_select_file(struct scard_data *scard, unsigned short file_id,
- unsigned char *buf, size_t *buf_len,
- sim_types sim_type, unsigned char *aid,
- size_t aidlen)
- {
- long ret;
- unsigned char resp[3];
- unsigned char cmd[50] = { SIM_CMD_SELECT };
- int cmdlen;
- unsigned char get_resp[5] = { SIM_CMD_GET_RESPONSE };
- size_t len, rlen;
- if (sim_type == SCARD_USIM) {
- cmd[0] = USIM_CLA;
- cmd[3] = 0x04;
- get_resp[0] = USIM_CLA;
- }
- wpa_printf(MSG_DEBUG, "SCARD: select file %04x", file_id);
- if (aid) {
- wpa_hexdump(MSG_DEBUG, "SCARD: select file by AID",
- aid, aidlen);
- if (5 + aidlen > sizeof(cmd))
- return -1;
- cmd[2] = 0x04; /* Select by AID */
- cmd[4] = aidlen; /* len */
- os_memcpy(cmd + 5, aid, aidlen);
- cmdlen = 5 + aidlen;
- } else {
- cmd[5] = file_id >> 8;
- cmd[6] = file_id & 0xff;
- cmdlen = 7;
- }
- len = sizeof(resp);
- ret = scard_transmit(scard, cmd, cmdlen, resp, &len);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_WARNING, "SCARD: SCardTransmit failed "
- "(err=0x%lx)", ret);
- return -1;
- }
- if (len != 2) {
- wpa_printf(MSG_WARNING, "SCARD: unexpected resp len "
- "%d (expected 2)", (int) len);
- return -1;
- }
- if (resp[0] == 0x98 && resp[1] == 0x04) {
- /* Security status not satisfied (PIN_WLAN) */
- wpa_printf(MSG_WARNING, "SCARD: Security status not satisfied "
- "(PIN_WLAN)");
- return -1;
- }
- if (resp[0] == 0x6e) {
- wpa_printf(MSG_DEBUG, "SCARD: used CLA not supported");
- return -1;
- }
- if (resp[0] != 0x6c && resp[0] != 0x9f && resp[0] != 0x61) {
- wpa_printf(MSG_WARNING, "SCARD: unexpected response 0x%02x "
- "(expected 0x61, 0x6c, or 0x9f)", resp[0]);
- return -1;
- }
- /* Normal ending of command; resp[1] bytes available */
- get_resp[4] = resp[1];
- wpa_printf(MSG_DEBUG, "SCARD: trying to get response (%d bytes)",
- resp[1]);
- rlen = *buf_len;
- ret = scard_transmit(scard, get_resp, sizeof(get_resp), buf, &rlen);
- if (ret == SCARD_S_SUCCESS) {
- *buf_len = resp[1] < rlen ? resp[1] : rlen;
- return 0;
- }
- wpa_printf(MSG_WARNING, "SCARD: SCardTransmit err=0x%lx\n", ret);
- return -1;
- }
- static int scard_select_file(struct scard_data *scard, unsigned short file_id,
- unsigned char *buf, size_t *buf_len)
- {
- return _scard_select_file(scard, file_id, buf, buf_len,
- scard->sim_type, NULL, 0);
- }
- static int scard_get_record_len(struct scard_data *scard, unsigned char recnum,
- unsigned char mode)
- {
- unsigned char buf[255];
- unsigned char cmd[5] = { SIM_CMD_READ_RECORD /* , len */ };
- size_t blen;
- long ret;
- if (scard->sim_type == SCARD_USIM)
- cmd[0] = USIM_CLA;
- cmd[2] = recnum;
- cmd[3] = mode;
- cmd[4] = sizeof(buf);
- blen = sizeof(buf);
- ret = scard_transmit(scard, cmd, sizeof(cmd), buf, &blen);
- if (ret != SCARD_S_SUCCESS) {
- wpa_printf(MSG_DEBUG, "SCARD: failed to determine file "
- "length for record %d", recnum);
- return -1;
- }
- wpa_hexdump(MSG_DEBUG, "SCARD: file length determination response",
- buf, blen);
- if (blen < 2 || (buf[0] != 0x6c && buf[0] != 0x67)) {
- wpa_printf(MSG_DEBUG, "SCARD: unexpected response to file "
- "length determination");
- return -1;
- }
- return buf[1];
- }
- static int scard_read_record(struct scard_data *scard,
- unsigned char *data, size_t len,
- unsigned char recnum, unsigned char mode)
- {
- unsigned char cmd[5] = { SIM_CMD_READ_RECORD /* , len */ };
- size_t blen = len + 3;
- unsigned char *buf;
- long ret;
- if (scard->sim_type == SCARD_USIM)
- cmd[0] = USIM_CLA;
- cmd[2] = recnum;
- cmd[3] = mode;
- cmd[4] = len;
- buf = os_malloc(blen);
- if (buf == NULL)
- return -1;
- ret = scard_transmit(scard, cmd, sizeof(cmd), buf, &blen);
- if (ret != SCARD_S_SUCCESS) {
- os_free(buf);
- return -2;
- }
- if (blen != len + 2) {
- wpa_printf(MSG_DEBUG, "SCARD: record read returned unexpected "
- "length %ld (expected %ld)",
- (long) blen, (long) len + 2);
- os_free(buf);
- return -3;
- }
- if (buf[len] != 0x90 || buf[len + 1] != 0x00) {
- wpa_printf(MSG_DEBUG, "SCARD: record read returned unexpected "
- "status %02x %02x (expected 90 00)",
- buf[len], buf[len + 1]);
- os_free(buf);
- return -4;
- }
- os_memcpy(data, buf, len);
- os_free(buf);
- return 0;
- }
- static int scard_read_file(struct scard_data *scard,
- unsigned char *data, size_t len)
- {
- unsigned char cmd[5] = { SIM_CMD_READ_BIN /* , len */ };
- size_t blen = len + 3;
- unsigned char *buf;
- long ret;
- cmd[4] = len;
- buf = os_malloc(blen);
- if (buf == NULL)
- return -1;
- if (scard->sim_type == SCARD_USIM)
- cmd[0] = USIM_CLA;
- ret = scard_transmit(scard, cmd, sizeof(cmd), buf, &blen);
- if (ret != SCARD_S_SUCCESS) {
- os_free(buf);
- return -2;
- }
- if (blen != len + 2) {
- wpa_printf(MSG_DEBUG, "SCARD: file read returned unexpected "
- "length %ld (expected %ld)",
- (long) blen, (long) len + 2);
- os_free(buf);
- return -3;
- }
- if (buf[len] != 0x90 || buf[len + 1] != 0x00) {
- wpa_printf(MSG_DEBUG, "SCARD: file read returned unexpected "
- "status %02x %02x (expected 90 00)",
- buf[len], buf[len + 1]);
- os_free(buf);
- return -4;
- }
- os_memcpy(data, buf, len);
- os_free(buf);
- return 0;
- }
- static int scard_verify_pin(struct scard_data *scard, const char *pin)
- {
- long ret;
- unsigned char resp[3];
- unsigned char cmd[5 + 8] = { SIM_CMD_VERIFY_CHV1 };
- size_t len;
- wpa_printf(MSG_DEBUG, "SCARD: verifying PIN");
- if (pin == NULL || os_strlen(pin) > 8)
- return -1;
- if (scard->sim_type == SCARD_USIM)
- cmd[0] = USIM_CLA;
- os_memcpy(cmd + 5, pin, os_strlen(pin));
- os_memset(cmd + 5 + os_strlen(pin), 0xff, 8 - os_strlen(pin));
- len = sizeof(resp);
- ret = scard_transmit(scard, cmd, sizeof(cmd), resp, &len);
- if (ret != SCARD_S_SUCCESS)
- return -2;
- if (len != 2 || resp[0] != 0x90 || resp[1] != 0x00) {
- wpa_printf(MSG_WARNING, "SCARD: PIN verification failed");
- return -1;
- }
- wpa_printf(MSG_DEBUG, "SCARD: PIN verified successfully");
- return 0;
- }
- int scard_get_pin_retry_counter(struct scard_data *scard)
- {
- long ret;
- unsigned char resp[3];
- unsigned char cmd[5] = { SIM_CMD_VERIFY_CHV1 };
- size_t len;
- u16 val;
- wpa_printf(MSG_DEBUG, "SCARD: fetching PIN retry counter");
- if (scard->sim_type == SCARD_USIM)
- cmd[0] = USIM_CLA;
- cmd[4] = 0; /* Empty data */
- len = sizeof(resp);
- ret = scard_transmit(scard, cmd, sizeof(cmd), resp, &len);
- if (ret != SCARD_S_SUCCESS)
- return -2;
- if (len != 2) {
- wpa_printf(MSG_WARNING, "SCARD: failed to fetch PIN retry "
- "counter");
- return -1;
- }
- val = WPA_GET_BE16(resp);
- if (val == 0x63c0 || val == 0x6983) {
- wpa_printf(MSG_DEBUG, "SCARD: PIN has been blocked");
- return 0;
- }
- if (val >= 0x63c0 && val <= 0x63cf)
- return val & 0x000f;
- wpa_printf(MSG_DEBUG, "SCARD: Unexpected PIN retry counter response "
- "value 0x%x", val);
- return 0;
- }
- /**
- * scard_get_imsi - Read IMSI from SIM/USIM card
- * @scard: Pointer to private data from scard_init()
- * @imsi: Buffer for IMSI
- * @len: Length of imsi buffer; set to IMSI length on success
- * Returns: 0 on success, -1 if IMSI file cannot be selected, -2 if IMSI file
- * selection returns invalid result code, -3 if parsing FSP template file fails
- * (USIM only), -4 if IMSI does not fit in the provided imsi buffer (len is set
- * to needed length), -5 if reading IMSI file fails.
- *
- * This function can be used to read IMSI from the SIM/USIM card. If the IMSI
- * file is PIN protected, scard_set_pin() must have been used to set the
- * correct PIN code before calling scard_get_imsi().
- */
- int scard_get_imsi(struct scard_data *scard, char *imsi, size_t *len)
- {
- unsigned char buf[100];
- size_t blen, imsilen, i;
- char *pos;
- wpa_printf(MSG_DEBUG, "SCARD: reading IMSI from (GSM) EF-IMSI");
- blen = sizeof(buf);
- if (scard_select_file(scard, SCARD_FILE_GSM_EF_IMSI, buf, &blen))
- return -1;
- if (blen < 4) {
- wpa_printf(MSG_WARNING, "SCARD: too short (GSM) EF-IMSI "
- "header (len=%ld)", (long) blen);
- return -2;
- }
- if (scard->sim_type == SCARD_GSM_SIM) {
- blen = WPA_GET_BE16(&buf[2]);
- } else {
- int file_size;
- if (scard_parse_fsp_templ(buf, blen, NULL, &file_size))
- return -3;
- blen = file_size;
- }
- if (blen < 2 || blen > sizeof(buf)) {
- wpa_printf(MSG_DEBUG, "SCARD: invalid IMSI file length=%ld",
- (long) blen);
- return -3;
- }
- imsilen = (blen - 2) * 2 + 1;
- wpa_printf(MSG_DEBUG, "SCARD: IMSI file length=%ld imsilen=%ld",
- (long) blen, (long) imsilen);
- if (blen < 2 || imsilen > *len) {
- *len = imsilen;
- return -4;
- }
- if (scard_read_file(scard, buf, blen))
- return -5;
- pos = imsi;
- *pos++ = '0' + (buf[1] >> 4 & 0x0f);
- for (i = 2; i < blen; i++) {
- unsigned char digit;
- digit = buf[i] & 0x0f;
- if (digit < 10)
- *pos++ = '0' + digit;
- else
- imsilen--;
- digit = buf[i] >> 4 & 0x0f;
- if (digit < 10)
- *pos++ = '0' + digit;
- else
- imsilen--;
- }
- *len = imsilen;
- return 0;
- }
- /**
- * scard_get_mnc_len - Read length of MNC in the IMSI from SIM/USIM card
- * @scard: Pointer to private data from scard_init()
- * Returns: length (>0) on success, -1 if administrative data file cannot be
- * selected, -2 if administrative data file selection returns invalid result
- * code, -3 if parsing FSP template file fails (USIM only), -4 if length of
- * the file is unexpected, -5 if reading file fails, -6 if MNC length is not
- * in range (i.e. 2 or 3), -7 if MNC length is not available.
- *
- */
- int scard_get_mnc_len(struct scard_data *scard)
- {
- unsigned char buf[100];
- size_t blen;
- int file_size;
- wpa_printf(MSG_DEBUG, "SCARD: reading MNC len from (GSM) EF-AD");
- blen = sizeof(buf);
- if (scard_select_file(scard, SCARD_FILE_GSM_EF_AD, buf, &blen))
- return -1;
- if (blen < 4) {
- wpa_printf(MSG_WARNING, "SCARD: too short (GSM) EF-AD "
- "header (len=%ld)", (long) blen);
- return -2;
- }
- if (scard->sim_type == SCARD_GSM_SIM) {
- file_size = WPA_GET_BE16(&buf[2]);
- } else {
- if (scard_parse_fsp_templ(buf, blen, NULL, &file_size))
- return -3;
- }
- if (file_size == 3) {
- wpa_printf(MSG_DEBUG, "SCARD: MNC length not available");
- return -7;
- }
- if (file_size < 4 || file_size > (int) sizeof(buf)) {
- wpa_printf(MSG_DEBUG, "SCARD: invalid file length=%ld",
- (long) file_size);
- return -4;
- }
- if (scard_read_file(scard, buf, file_size))
- return -5;
- buf[3] = buf[3] & 0x0f; /* upper nibble reserved for future use */
- if (buf[3] < 2 || buf[3] > 3) {
- wpa_printf(MSG_DEBUG, "SCARD: invalid MNC length=%ld",
- (long) buf[3]);
- return -6;
- }
- wpa_printf(MSG_DEBUG, "SCARD: MNC length=%ld", (long) buf[3]);
- return buf[3];
- }
- /**
- * scard_gsm_auth - Run GSM authentication command on SIM card
- * @scard: Pointer to private data from scard_init()
- * @_rand: 16-byte RAND value from HLR/AuC
- * @sres: 4-byte buffer for SRES
- * @kc: 8-byte buffer for Kc
- * Returns: 0 on success, -1 if SIM/USIM connection has not been initialized,
- * -2 if authentication command execution fails, -3 if unknown response code
- * for authentication command is received, -4 if reading of response fails,
- * -5 if if response data is of unexpected length
- *
- * This function performs GSM authentication using SIM/USIM card and the
- * provided RAND value from HLR/AuC. If authentication command can be completed
- * successfully, SRES and Kc values will be written into sres and kc buffers.
- */
- int scard_gsm_auth(struct scard_data *scard, const unsigned char *_rand,
- unsigned char *sres, unsigned char *kc)
- {
- unsigned char cmd[5 + 1 + 16] = { SIM_CMD_RUN_GSM_ALG };
- int cmdlen;
- unsigned char get_resp[5] = { SIM_CMD_GET_RESPONSE };
- unsigned char resp[3], buf[12 + 3 + 2];
- size_t len;
- long ret;
- if (scard == NULL)
- return -1;
- wpa_hexdump(MSG_DEBUG, "SCARD: GSM auth - RAND", _rand, 16);
- if (scard->sim_type == SCARD_GSM_SIM) {
- cmdlen = 5 + 16;
- os_memcpy(cmd + 5, _rand, 16);
- } else {
- cmdlen = 5 + 1 + 16;
- cmd[0] = USIM_CLA;
- cmd[3] = 0x80;
- cmd[4] = 17;
- cmd[5] = 16;
- os_memcpy(cmd + 6, _rand, 16);
- get_resp[0] = USIM_CLA;
- }
- len = sizeof(resp);
- ret = scard_transmit(scard, cmd, cmdlen, resp, &len);
- if (ret != SCARD_S_SUCCESS)
- return -2;
- if ((scard->sim_type == SCARD_GSM_SIM &&
- (len != 2 || resp[0] != 0x9f || resp[1] != 0x0c)) ||
- (scard->sim_type == SCARD_USIM &&
- (len != 2 || resp[0] != 0x61 || resp[1] != 0x0e))) {
- wpa_printf(MSG_WARNING, "SCARD: unexpected response for GSM "
- "auth request (len=%ld resp=%02x %02x)",
- (long) len, resp[0], resp[1]);
- return -3;
- }
- get_resp[4] = resp[1];
- len = sizeof(buf);
- ret = scard_transmit(scard, get_resp, sizeof(get_resp), buf, &len);
- if (ret != SCARD_S_SUCCESS)
- return -4;
- if (scard->sim_type == SCARD_GSM_SIM) {
- if (len != 4 + 8 + 2) {
- wpa_printf(MSG_WARNING, "SCARD: unexpected data "
- "length for GSM auth (len=%ld, expected 14)",
- (long) len);
- return -5;
- }
- os_memcpy(sres, buf, 4);
- os_memcpy(kc, buf + 4, 8);
- } else {
- if (len != 1 + 4 + 1 + 8 + 2) {
- wpa_printf(MSG_WARNING, "SCARD: unexpected data "
- "length for USIM auth (len=%ld, "
- "expected 16)", (long) len);
- return -5;
- }
- if (buf[0] != 4 || buf[5] != 8) {
- wpa_printf(MSG_WARNING, "SCARD: unexpected SREC/Kc "
- "length (%d %d, expected 4 8)",
- buf[0], buf[5]);
- }
- os_memcpy(sres, buf + 1, 4);
- os_memcpy(kc, buf + 6, 8);
- }
- wpa_hexdump(MSG_DEBUG, "SCARD: GSM auth - SRES", sres, 4);
- wpa_hexdump(MSG_DEBUG, "SCARD: GSM auth - Kc", kc, 8);
- return 0;
- }
- /**
- * scard_umts_auth - Run UMTS authentication command on USIM card
- * @scard: Pointer to private data from scard_init()
- * @_rand: 16-byte RAND value from HLR/AuC
- * @autn: 16-byte AUTN value from HLR/AuC
- * @res: 16-byte buffer for RES
- * @res_len: Variable that will be set to RES length
- * @ik: 16-byte buffer for IK
- * @ck: 16-byte buffer for CK
- * @auts: 14-byte buffer for AUTS
- * Returns: 0 on success, -1 on failure, or -2 if USIM reports synchronization
- * failure
- *
- * This function performs AKA authentication using USIM card and the provided
- * RAND and AUTN values from HLR/AuC. If authentication command can be
- * completed successfully, RES, IK, and CK values will be written into provided
- * buffers and res_len is set to length of received RES value. If USIM reports
- * synchronization failure, the received AUTS value will be written into auts
- * buffer. In this case, RES, IK, and CK are not valid.
- */
- int scard_umts_auth(struct scard_data *scard, const unsigned char *_rand,
- const unsigned char *autn,
- unsigned char *res, size_t *res_len,
- unsigned char *ik, unsigned char *ck, unsigned char *auts)
- {
- unsigned char cmd[5 + 1 + AKA_RAND_LEN + 1 + AKA_AUTN_LEN] =
- { USIM_CMD_RUN_UMTS_ALG };
- unsigned char get_resp[5] = { USIM_CMD_GET_RESPONSE };
- unsigned char resp[3], buf[64], *pos, *end;
- size_t len;
- long ret;
- if (scard == NULL)
- return -1;
- if (scard->sim_type == SCARD_GSM_SIM) {
- wpa_printf(MSG_ERROR, "SCARD: Non-USIM card - cannot do UMTS "
- "auth");
- return -1;
- }
- wpa_hexdump(MSG_DEBUG, "SCARD: UMTS auth - RAND", _rand, AKA_RAND_LEN);
- wpa_hexdump(MSG_DEBUG, "SCARD: UMTS auth - AUTN", autn, AKA_AUTN_LEN);
- cmd[5] = AKA_RAND_LEN;
- os_memcpy(cmd + 6, _rand, AKA_RAND_LEN);
- cmd[6 + AKA_RAND_LEN] = AKA_AUTN_LEN;
- os_memcpy(cmd + 6 + AKA_RAND_LEN + 1, autn, AKA_AUTN_LEN);
- len = sizeof(resp);
- ret = scard_transmit(scard, cmd, sizeof(cmd), resp, &len);
- if (ret != SCARD_S_SUCCESS)
- return -1;
- if (len <= sizeof(resp))
- wpa_hexdump(MSG_DEBUG, "SCARD: UMTS alg response", resp, len);
- if (len == 2 && resp[0] == 0x98 && resp[1] == 0x62) {
- wpa_printf(MSG_WARNING, "SCARD: UMTS auth failed - "
- "MAC != XMAC");
- return -1;
- } else if (len != 2 || resp[0] != 0x61) {
- wpa_printf(MSG_WARNING, "SCARD: unexpected response for UMTS "
- "auth request (len=%ld resp=%02x %02x)",
- (long) len, resp[0], resp[1]);
- return -1;
- }
- get_resp[4] = resp[1];
- len = sizeof(buf);
- ret = scard_transmit(scard, get_resp, sizeof(get_resp), buf, &len);
- if (ret != SCARD_S_SUCCESS || len > sizeof(buf))
- return -1;
- wpa_hexdump(MSG_DEBUG, "SCARD: UMTS get response result", buf, len);
- if (len >= 2 + AKA_AUTS_LEN && buf[0] == 0xdc &&
- buf[1] == AKA_AUTS_LEN) {
- wpa_printf(MSG_DEBUG, "SCARD: UMTS Synchronization-Failure");
- os_memcpy(auts, buf + 2, AKA_AUTS_LEN);
- wpa_hexdump(MSG_DEBUG, "SCARD: AUTS", auts, AKA_AUTS_LEN);
- return -2;
- } else if (len >= 6 + IK_LEN + CK_LEN && buf[0] == 0xdb) {
- pos = buf + 1;
- end = buf + len;
- /* RES */
- if (pos[0] > RES_MAX_LEN || pos + pos[0] > end) {
- wpa_printf(MSG_DEBUG, "SCARD: Invalid RES");
- return -1;
- }
- *res_len = *pos++;
- os_memcpy(res, pos, *res_len);
- pos += *res_len;
- wpa_hexdump(MSG_DEBUG, "SCARD: RES", res, *res_len);
- /* CK */
- if (pos[0] != CK_LEN || pos + CK_LEN > end) {
- wpa_printf(MSG_DEBUG, "SCARD: Invalid CK");
- return -1;
- }
- pos++;
- os_memcpy(ck, pos, CK_LEN);
- pos += CK_LEN;
- wpa_hexdump(MSG_DEBUG, "SCARD: CK", ck, CK_LEN);
- /* IK */
- if (pos[0] != IK_LEN || pos + IK_LEN > end) {
- wpa_printf(MSG_DEBUG, "SCARD: Invalid IK");
- return -1;
- }
- pos++;
- os_memcpy(ik, pos, IK_LEN);
- pos += IK_LEN;
- wpa_hexdump(MSG_DEBUG, "SCARD: IK", ik, IK_LEN);
- if (end > pos) {
- wpa_hexdump(MSG_DEBUG,
- "SCARD: Ignore extra data in end",
- pos, end - pos);
- }
- return 0;
- }
- wpa_printf(MSG_DEBUG, "SCARD: Unrecognized response");
- return -1;
- }
- int scard_supports_umts(struct scard_data *scard)
- {
- return scard->sim_type == SCARD_USIM;
- }
|