LCOV - code coverage report
Current view: top level - src/radius - radius.c (source / functions) Hit Total Coverage
Test: wpa_supplicant/hostapd combined for hwsim test run 1443382998 Lines: 663 783 84.7 %
Date: 2015-09-27 Functions: 43 44 97.7 %

          Line data    Source code
       1             : /*
       2             :  * RADIUS message processing
       3             :  * Copyright (c) 2002-2009, 2011-2014, 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             : 
       9             : #include "utils/includes.h"
      10             : 
      11             : #include "utils/common.h"
      12             : #include "utils/wpabuf.h"
      13             : #include "crypto/md5.h"
      14             : #include "crypto/crypto.h"
      15             : #include "radius.h"
      16             : 
      17             : 
      18             : /**
      19             :  * struct radius_msg - RADIUS message structure for new and parsed messages
      20             :  */
      21             : struct radius_msg {
      22             :         /**
      23             :          * buf - Allocated buffer for RADIUS message
      24             :          */
      25             :         struct wpabuf *buf;
      26             : 
      27             :         /**
      28             :          * hdr - Pointer to the RADIUS header in buf
      29             :          */
      30             :         struct radius_hdr *hdr;
      31             : 
      32             :         /**
      33             :          * attr_pos - Array of indexes to attributes
      34             :          *
      35             :          * The values are number of bytes from buf to the beginning of
      36             :          * struct radius_attr_hdr.
      37             :          */
      38             :         size_t *attr_pos;
      39             : 
      40             :         /**
      41             :          * attr_size - Total size of the attribute pointer array
      42             :          */
      43             :         size_t attr_size;
      44             : 
      45             :         /**
      46             :          * attr_used - Total number of attributes in the array
      47             :          */
      48             :         size_t attr_used;
      49             : };
      50             : 
      51             : 
      52       38518 : struct radius_hdr * radius_msg_get_hdr(struct radius_msg *msg)
      53             : {
      54       38518 :         return msg->hdr;
      55             : }
      56             : 
      57             : 
      58        8154 : struct wpabuf * radius_msg_get_buf(struct radius_msg *msg)
      59             : {
      60        8154 :         return msg->buf;
      61             : }
      62             : 
      63             : 
      64             : static struct radius_attr_hdr *
      65      492454 : radius_get_attr_hdr(struct radius_msg *msg, int idx)
      66             : {
      67      492454 :         return (struct radius_attr_hdr *)
      68      492454 :                 (wpabuf_mhead_u8(msg->buf) + msg->attr_pos[idx]);
      69             : }
      70             : 
      71             : 
      72        8129 : static void radius_msg_set_hdr(struct radius_msg *msg, u8 code, u8 identifier)
      73             : {
      74        8129 :         msg->hdr->code = code;
      75        8129 :         msg->hdr->identifier = identifier;
      76        8129 : }
      77             : 
      78             : 
      79       16155 : static int radius_msg_initialize(struct radius_msg *msg)
      80             : {
      81       16155 :         msg->attr_pos = os_calloc(RADIUS_DEFAULT_ATTR_COUNT,
      82             :                                   sizeof(*msg->attr_pos));
      83       16155 :         if (msg->attr_pos == NULL)
      84           7 :                 return -1;
      85             : 
      86       16148 :         msg->attr_size = RADIUS_DEFAULT_ATTR_COUNT;
      87       16148 :         msg->attr_used = 0;
      88             : 
      89       16148 :         return 0;
      90             : }
      91             : 
      92             : 
      93             : /**
      94             :  * radius_msg_new - Create a new RADIUS message
      95             :  * @code: Code for RADIUS header
      96             :  * @identifier: Identifier for RADIUS header
      97             :  * Returns: Context for RADIUS message or %NULL on failure
      98             :  *
      99             :  * The caller is responsible for freeing the returned data with
     100             :  * radius_msg_free().
     101             :  */
     102        8139 : struct radius_msg * radius_msg_new(u8 code, u8 identifier)
     103             : {
     104             :         struct radius_msg *msg;
     105             : 
     106        8139 :         msg = os_zalloc(sizeof(*msg));
     107        8139 :         if (msg == NULL)
     108           5 :                 return NULL;
     109             : 
     110        8134 :         msg->buf = wpabuf_alloc(RADIUS_DEFAULT_MSG_SIZE);
     111        8134 :         if (msg->buf == NULL || radius_msg_initialize(msg)) {
     112           5 :                 radius_msg_free(msg);
     113           5 :                 return NULL;
     114             :         }
     115        8129 :         msg->hdr = wpabuf_put(msg->buf, sizeof(struct radius_hdr));
     116             : 
     117        8129 :         radius_msg_set_hdr(msg, code, identifier);
     118             : 
     119        8129 :         return msg;
     120             : }
     121             : 
     122             : 
     123             : /**
     124             :  * radius_msg_free - Free a RADIUS message
     125             :  * @msg: RADIUS message from radius_msg_new() or radius_msg_parse()
     126             :  */
     127       19254 : void radius_msg_free(struct radius_msg *msg)
     128             : {
     129       19254 :         if (msg == NULL)
     130       22346 :                 return;
     131             : 
     132       16162 :         wpabuf_free(msg->buf);
     133       16162 :         os_free(msg->attr_pos);
     134       16162 :         os_free(msg);
     135             : }
     136             : 
     137             : 
     138       16138 : static const char *radius_code_string(u8 code)
     139             : {
     140       16138 :         switch (code) {
     141        7078 :         case RADIUS_CODE_ACCESS_REQUEST: return "Access-Request";
     142        1350 :         case RADIUS_CODE_ACCESS_ACCEPT: return "Access-Accept";
     143         209 :         case RADIUS_CODE_ACCESS_REJECT: return "Access-Reject";
     144        1029 :         case RADIUS_CODE_ACCOUNTING_REQUEST: return "Accounting-Request";
     145         920 :         case RADIUS_CODE_ACCOUNTING_RESPONSE: return "Accounting-Response";
     146        5499 :         case RADIUS_CODE_ACCESS_CHALLENGE: return "Access-Challenge";
     147           0 :         case RADIUS_CODE_STATUS_SERVER: return "Status-Server";
     148           0 :         case RADIUS_CODE_STATUS_CLIENT: return "Status-Client";
     149           0 :         case RADIUS_CODE_RESERVED: return "Reserved";
     150          27 :         case RADIUS_CODE_DISCONNECT_REQUEST: return "Disconnect-Request";
     151          10 :         case RADIUS_CODE_DISCONNECT_ACK: return "Disconnect-ACK";
     152          14 :         case RADIUS_CODE_DISCONNECT_NAK: return "Disconnect-NAK";
     153           1 :         case RADIUS_CODE_COA_REQUEST: return "CoA-Request";
     154           0 :         case RADIUS_CODE_COA_ACK: return "CoA-ACK";
     155           1 :         case RADIUS_CODE_COA_NAK: return "CoA-NAK";
     156           0 :         default: return "?Unknown?";
     157             :         }
     158             : }
     159             : 
     160             : 
     161             : struct radius_attr_type {
     162             :         u8 type;
     163             :         char *name;
     164             :         enum {
     165             :                 RADIUS_ATTR_UNDIST, RADIUS_ATTR_TEXT, RADIUS_ATTR_IP,
     166             :                 RADIUS_ATTR_HEXDUMP, RADIUS_ATTR_INT32, RADIUS_ATTR_IPV6
     167             :         } data_type;
     168             : };
     169             : 
     170             : static const struct radius_attr_type radius_attrs[] =
     171             : {
     172             :         { RADIUS_ATTR_USER_NAME, "User-Name", RADIUS_ATTR_TEXT },
     173             :         { RADIUS_ATTR_USER_PASSWORD, "User-Password", RADIUS_ATTR_UNDIST },
     174             :         { RADIUS_ATTR_NAS_IP_ADDRESS, "NAS-IP-Address", RADIUS_ATTR_IP },
     175             :         { RADIUS_ATTR_NAS_PORT, "NAS-Port", RADIUS_ATTR_INT32 },
     176             :         { RADIUS_ATTR_FRAMED_MTU, "Framed-MTU", RADIUS_ATTR_INT32 },
     177             :         { RADIUS_ATTR_REPLY_MESSAGE, "Reply-Message", RADIUS_ATTR_TEXT },
     178             :         { RADIUS_ATTR_STATE, "State", RADIUS_ATTR_UNDIST },
     179             :         { RADIUS_ATTR_CLASS, "Class", RADIUS_ATTR_UNDIST },
     180             :         { RADIUS_ATTR_VENDOR_SPECIFIC, "Vendor-Specific", RADIUS_ATTR_UNDIST },
     181             :         { RADIUS_ATTR_SESSION_TIMEOUT, "Session-Timeout", RADIUS_ATTR_INT32 },
     182             :         { RADIUS_ATTR_IDLE_TIMEOUT, "Idle-Timeout", RADIUS_ATTR_INT32 },
     183             :         { RADIUS_ATTR_TERMINATION_ACTION, "Termination-Action",
     184             :           RADIUS_ATTR_INT32 },
     185             :         { RADIUS_ATTR_CALLED_STATION_ID, "Called-Station-Id",
     186             :           RADIUS_ATTR_TEXT },
     187             :         { RADIUS_ATTR_CALLING_STATION_ID, "Calling-Station-Id",
     188             :           RADIUS_ATTR_TEXT },
     189             :         { RADIUS_ATTR_NAS_IDENTIFIER, "NAS-Identifier", RADIUS_ATTR_TEXT },
     190             :         { RADIUS_ATTR_PROXY_STATE, "Proxy-State", RADIUS_ATTR_UNDIST },
     191             :         { RADIUS_ATTR_ACCT_STATUS_TYPE, "Acct-Status-Type",
     192             :           RADIUS_ATTR_INT32 },
     193             :         { RADIUS_ATTR_ACCT_DELAY_TIME, "Acct-Delay-Time", RADIUS_ATTR_INT32 },
     194             :         { RADIUS_ATTR_ACCT_INPUT_OCTETS, "Acct-Input-Octets",
     195             :           RADIUS_ATTR_INT32 },
     196             :         { RADIUS_ATTR_ACCT_OUTPUT_OCTETS, "Acct-Output-Octets",
     197             :           RADIUS_ATTR_INT32 },
     198             :         { RADIUS_ATTR_ACCT_SESSION_ID, "Acct-Session-Id", RADIUS_ATTR_TEXT },
     199             :         { RADIUS_ATTR_ACCT_AUTHENTIC, "Acct-Authentic", RADIUS_ATTR_INT32 },
     200             :         { RADIUS_ATTR_ACCT_SESSION_TIME, "Acct-Session-Time",
     201             :           RADIUS_ATTR_INT32 },
     202             :         { RADIUS_ATTR_ACCT_INPUT_PACKETS, "Acct-Input-Packets",
     203             :           RADIUS_ATTR_INT32 },
     204             :         { RADIUS_ATTR_ACCT_OUTPUT_PACKETS, "Acct-Output-Packets",
     205             :           RADIUS_ATTR_INT32 },
     206             :         { RADIUS_ATTR_ACCT_TERMINATE_CAUSE, "Acct-Terminate-Cause",
     207             :           RADIUS_ATTR_INT32 },
     208             :         { RADIUS_ATTR_ACCT_MULTI_SESSION_ID, "Acct-Multi-Session-Id",
     209             :           RADIUS_ATTR_TEXT },
     210             :         { RADIUS_ATTR_ACCT_LINK_COUNT, "Acct-Link-Count", RADIUS_ATTR_INT32 },
     211             :         { RADIUS_ATTR_ACCT_INPUT_GIGAWORDS, "Acct-Input-Gigawords", 
     212             :           RADIUS_ATTR_INT32 },
     213             :         { RADIUS_ATTR_ACCT_OUTPUT_GIGAWORDS, "Acct-Output-Gigawords",
     214             :           RADIUS_ATTR_INT32 },
     215             :         { RADIUS_ATTR_EVENT_TIMESTAMP, "Event-Timestamp",
     216             :           RADIUS_ATTR_INT32 },
     217             :         { RADIUS_ATTR_NAS_PORT_TYPE, "NAS-Port-Type", RADIUS_ATTR_INT32 },
     218             :         { RADIUS_ATTR_TUNNEL_TYPE, "Tunnel-Type", RADIUS_ATTR_HEXDUMP },
     219             :         { RADIUS_ATTR_TUNNEL_MEDIUM_TYPE, "Tunnel-Medium-Type",
     220             :           RADIUS_ATTR_HEXDUMP },
     221             :         { RADIUS_ATTR_TUNNEL_PASSWORD, "Tunnel-Password",
     222             :           RADIUS_ATTR_UNDIST },
     223             :         { RADIUS_ATTR_CONNECT_INFO, "Connect-Info", RADIUS_ATTR_TEXT },
     224             :         { RADIUS_ATTR_EAP_MESSAGE, "EAP-Message", RADIUS_ATTR_UNDIST },
     225             :         { RADIUS_ATTR_MESSAGE_AUTHENTICATOR, "Message-Authenticator",
     226             :           RADIUS_ATTR_UNDIST },
     227             :         { RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID, "Tunnel-Private-Group-Id",
     228             :           RADIUS_ATTR_HEXDUMP },
     229             :         { RADIUS_ATTR_ACCT_INTERIM_INTERVAL, "Acct-Interim-Interval",
     230             :           RADIUS_ATTR_INT32 },
     231             :         { RADIUS_ATTR_CHARGEABLE_USER_IDENTITY, "Chargeable-User-Identity",
     232             :           RADIUS_ATTR_TEXT },
     233             :         { RADIUS_ATTR_NAS_IPV6_ADDRESS, "NAS-IPv6-Address", RADIUS_ATTR_IPV6 },
     234             :         { RADIUS_ATTR_ERROR_CAUSE, "Error-Cause", RADIUS_ATTR_INT32 },
     235             :         { RADIUS_ATTR_EAP_KEY_NAME, "EAP-Key-Name", RADIUS_ATTR_HEXDUMP },
     236             :         { RADIUS_ATTR_OPERATOR_NAME, "Operator-Name", RADIUS_ATTR_TEXT },
     237             :         { RADIUS_ATTR_LOCATION_INFO, "Location-Information",
     238             :           RADIUS_ATTR_HEXDUMP },
     239             :         { RADIUS_ATTR_LOCATION_DATA, "Location-Data", RADIUS_ATTR_HEXDUMP },
     240             :         { RADIUS_ATTR_BASIC_LOCATION_POLICY_RULES,
     241             :           "Basic-Location-Policy-Rules", RADIUS_ATTR_HEXDUMP },
     242             :         { RADIUS_ATTR_EXTENDED_LOCATION_POLICY_RULES,
     243             :           "Extended-Location-Policy-Rules", RADIUS_ATTR_HEXDUMP },
     244             :         { RADIUS_ATTR_LOCATION_CAPABLE, "Location-Capable", RADIUS_ATTR_INT32 },
     245             :         { RADIUS_ATTR_REQUESTED_LOCATION_INFO, "Requested-Location-Info",
     246             :           RADIUS_ATTR_INT32 },
     247             :         { RADIUS_ATTR_MOBILITY_DOMAIN_ID, "Mobility-Domain-Id",
     248             :           RADIUS_ATTR_INT32 },
     249             :         { RADIUS_ATTR_WLAN_HESSID, "WLAN-HESSID", RADIUS_ATTR_TEXT },
     250             :         { RADIUS_ATTR_WLAN_PAIRWISE_CIPHER, "WLAN-Pairwise-Cipher",
     251             :           RADIUS_ATTR_HEXDUMP },
     252             :         { RADIUS_ATTR_WLAN_GROUP_CIPHER, "WLAN-Group-Cipher",
     253             :           RADIUS_ATTR_HEXDUMP },
     254             :         { RADIUS_ATTR_WLAN_AKM_SUITE, "WLAN-AKM-Suite",
     255             :           RADIUS_ATTR_HEXDUMP },
     256             :         { RADIUS_ATTR_WLAN_GROUP_MGMT_CIPHER, "WLAN-Group-Mgmt-Pairwise-Cipher",
     257             :           RADIUS_ATTR_HEXDUMP },
     258             : };
     259             : #define RADIUS_ATTRS ARRAY_SIZE(radius_attrs)
     260             : 
     261             : 
     262      147967 : static const struct radius_attr_type *radius_get_attr_type(u8 type)
     263             : {
     264             :         size_t i;
     265             : 
     266     3934900 :         for (i = 0; i < RADIUS_ATTRS; i++) {
     267     3934900 :                 if (type == radius_attrs[i].type)
     268      147967 :                         return &radius_attrs[i];
     269             :         }
     270             : 
     271           0 :         return NULL;
     272             : }
     273             : 
     274             : 
     275      147967 : static void radius_msg_dump_attr(struct radius_attr_hdr *hdr)
     276             : {
     277             :         const struct radius_attr_type *attr;
     278             :         int len;
     279             :         unsigned char *pos;
     280             :         char buf[1000];
     281             : 
     282      147967 :         attr = radius_get_attr_type(hdr->type);
     283             : 
     284      295934 :         wpa_printf(MSG_INFO, "   Attribute %d (%s) length=%d",
     285      295934 :                    hdr->type, attr ? attr->name : "?Unknown?", hdr->length);
     286             : 
     287      147967 :         if (attr == NULL || hdr->length < sizeof(struct radius_attr_hdr))
     288      147967 :                 return;
     289             : 
     290      147967 :         len = hdr->length - sizeof(struct radius_attr_hdr);
     291      147967 :         pos = (unsigned char *) (hdr + 1);
     292             : 
     293      147967 :         switch (attr->data_type) {
     294             :         case RADIUS_ATTR_TEXT:
     295       47996 :                 printf_encode(buf, sizeof(buf), pos, len);
     296       47996 :                 wpa_printf(MSG_INFO, "      Value: '%s'", buf);
     297       47996 :                 break;
     298             : 
     299             :         case RADIUS_ATTR_IP:
     300          75 :                 if (len == 4) {
     301             :                         struct in_addr addr;
     302          75 :                         os_memcpy(&addr, pos, 4);
     303          75 :                         wpa_printf(MSG_INFO, "      Value: %s",
     304             :                                    inet_ntoa(addr));
     305             :                 } else {
     306           0 :                         wpa_printf(MSG_INFO, "      Invalid IP address length %d",
     307             :                                    len);
     308             :                 }
     309          75 :                 break;
     310             : 
     311             : #ifdef CONFIG_IPV6
     312             :         case RADIUS_ATTR_IPV6:
     313          14 :                 if (len == 16) {
     314             :                         const char *atxt;
     315          14 :                         struct in6_addr *addr = (struct in6_addr *) pos;
     316          14 :                         atxt = inet_ntop(AF_INET6, addr, buf, sizeof(buf));
     317          14 :                         wpa_printf(MSG_INFO, "      Value: %s",
     318             :                                    atxt ? atxt : "?");
     319             :                 } else {
     320           0 :                         wpa_printf(MSG_INFO, "      Invalid IPv6 address length %d",
     321             :                                    len);
     322             :                 }
     323          14 :                 break;
     324             : #endif /* CONFIG_IPV6 */
     325             : 
     326             :         case RADIUS_ATTR_HEXDUMP:
     327             :         case RADIUS_ATTR_UNDIST:
     328       71510 :                 wpa_snprintf_hex(buf, sizeof(buf), pos, len);
     329       71510 :                 wpa_printf(MSG_INFO, "      Value: %s", buf);
     330       71510 :                 break;
     331             : 
     332             :         case RADIUS_ATTR_INT32:
     333       28372 :                 if (len == 4)
     334       28372 :                         wpa_printf(MSG_INFO, "      Value: %u",
     335             :                                    WPA_GET_BE32(pos));
     336             :                 else
     337           0 :                         wpa_printf(MSG_INFO, "      Invalid INT32 length %d",
     338             :                                    len);
     339       28372 :                 break;
     340             : 
     341             :         default:
     342           0 :                 break;
     343             :         }
     344             : }
     345             : 
     346             : 
     347       16138 : void radius_msg_dump(struct radius_msg *msg)
     348             : {
     349             :         size_t i;
     350             : 
     351       64552 :         wpa_printf(MSG_INFO, "RADIUS message: code=%d (%s) identifier=%d length=%d",
     352       32276 :                    msg->hdr->code, radius_code_string(msg->hdr->code),
     353       32276 :                    msg->hdr->identifier, be_to_host16(msg->hdr->length));
     354             : 
     355      164105 :         for (i = 0; i < msg->attr_used; i++) {
     356      147967 :                 struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
     357      147967 :                 radius_msg_dump_attr(attr);
     358             :         }
     359       16138 : }
     360             : 
     361             : 
     362        3769 : int radius_msg_finish(struct radius_msg *msg, const u8 *secret,
     363             :                       size_t secret_len)
     364             : {
     365        3769 :         if (secret) {
     366             :                 u8 auth[MD5_MAC_LEN];
     367             :                 struct radius_attr_hdr *attr;
     368             : 
     369        3769 :                 os_memset(auth, 0, MD5_MAC_LEN);
     370        3769 :                 attr = radius_msg_add_attr(msg,
     371             :                                            RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
     372             :                                            auth, MD5_MAC_LEN);
     373        3769 :                 if (attr == NULL) {
     374           0 :                         wpa_printf(MSG_WARNING, "RADIUS: Could not add "
     375             :                                    "Message-Authenticator");
     376           0 :                         return -1;
     377             :                 }
     378        3769 :                 msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
     379        7538 :                 hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
     380        3769 :                          wpabuf_len(msg->buf), (u8 *) (attr + 1));
     381             :         } else
     382           0 :                 msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
     383             : 
     384        3769 :         if (wpabuf_len(msg->buf) > 0xffff) {
     385           0 :                 wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
     386           0 :                            (unsigned long) wpabuf_len(msg->buf));
     387           0 :                 return -1;
     388             :         }
     389        3769 :         return 0;
     390             : }
     391             : 
     392             : 
     393        3297 : int radius_msg_finish_srv(struct radius_msg *msg, const u8 *secret,
     394             :                           size_t secret_len, const u8 *req_authenticator)
     395             : {
     396             :         u8 auth[MD5_MAC_LEN];
     397             :         struct radius_attr_hdr *attr;
     398             :         const u8 *addr[4];
     399             :         size_t len[4];
     400             : 
     401        3297 :         os_memset(auth, 0, MD5_MAC_LEN);
     402        3297 :         attr = radius_msg_add_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
     403             :                                    auth, MD5_MAC_LEN);
     404        3297 :         if (attr == NULL) {
     405           0 :                 wpa_printf(MSG_ERROR, "WARNING: Could not add Message-Authenticator");
     406           0 :                 return -1;
     407             :         }
     408        3297 :         msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
     409        3297 :         os_memcpy(msg->hdr->authenticator, req_authenticator,
     410             :                   sizeof(msg->hdr->authenticator));
     411        6594 :         hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
     412        3297 :                  wpabuf_len(msg->buf), (u8 *) (attr + 1));
     413             : 
     414             :         /* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
     415        3297 :         addr[0] = (u8 *) msg->hdr;
     416        3297 :         len[0] = 1 + 1 + 2;
     417        3297 :         addr[1] = req_authenticator;
     418        3297 :         len[1] = MD5_MAC_LEN;
     419        3297 :         addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
     420        3297 :         len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
     421        3297 :         addr[3] = secret;
     422        3297 :         len[3] = secret_len;
     423        3297 :         md5_vector(4, addr, len, msg->hdr->authenticator);
     424             : 
     425        3297 :         if (wpabuf_len(msg->buf) > 0xffff) {
     426           0 :                 wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
     427           0 :                            (unsigned long) wpabuf_len(msg->buf));
     428           0 :                 return -1;
     429             :         }
     430        3297 :         return 0;
     431             : }
     432             : 
     433             : 
     434          25 : int radius_msg_finish_das_resp(struct radius_msg *msg, const u8 *secret,
     435             :                                size_t secret_len,
     436             :                                const struct radius_hdr *req_hdr)
     437             : {
     438             :         const u8 *addr[2];
     439             :         size_t len[2];
     440             :         u8 auth[MD5_MAC_LEN];
     441             :         struct radius_attr_hdr *attr;
     442             : 
     443          25 :         os_memset(auth, 0, MD5_MAC_LEN);
     444          25 :         attr = radius_msg_add_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
     445             :                                    auth, MD5_MAC_LEN);
     446          25 :         if (attr == NULL) {
     447           0 :                 wpa_printf(MSG_WARNING, "Could not add Message-Authenticator");
     448           0 :                 return -1;
     449             :         }
     450             : 
     451          25 :         msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
     452          25 :         os_memcpy(msg->hdr->authenticator, req_hdr->authenticator, 16);
     453          50 :         hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
     454          25 :                  wpabuf_len(msg->buf), (u8 *) (attr + 1));
     455             : 
     456             :         /* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
     457          25 :         addr[0] = wpabuf_head_u8(msg->buf);
     458          25 :         len[0] = wpabuf_len(msg->buf);
     459          25 :         addr[1] = secret;
     460          25 :         len[1] = secret_len;
     461          25 :         if (md5_vector(2, addr, len, msg->hdr->authenticator) < 0)
     462           0 :                 return -1;
     463             : 
     464          25 :         if (wpabuf_len(msg->buf) > 0xffff) {
     465           0 :                 wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
     466           0 :                            (unsigned long) wpabuf_len(msg->buf));
     467           0 :                 return -1;
     468             :         }
     469          25 :         return 0;
     470             : }
     471             : 
     472             : 
     473         541 : void radius_msg_finish_acct(struct radius_msg *msg, const u8 *secret,
     474             :                             size_t secret_len)
     475             : {
     476             :         const u8 *addr[2];
     477             :         size_t len[2];
     478             : 
     479         541 :         msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
     480         541 :         os_memset(msg->hdr->authenticator, 0, MD5_MAC_LEN);
     481         541 :         addr[0] = wpabuf_head(msg->buf);
     482         541 :         len[0] = wpabuf_len(msg->buf);
     483         541 :         addr[1] = secret;
     484         541 :         len[1] = secret_len;
     485         541 :         md5_vector(2, addr, len, msg->hdr->authenticator);
     486             : 
     487         541 :         if (wpabuf_len(msg->buf) > 0xffff) {
     488           0 :                 wpa_printf(MSG_WARNING, "RADIUS: Too long messages (%lu)",
     489           0 :                            (unsigned long) wpabuf_len(msg->buf));
     490             :         }
     491         541 : }
     492             : 
     493             : 
     494         488 : void radius_msg_finish_acct_resp(struct radius_msg *msg, const u8 *secret,
     495             :                                  size_t secret_len, const u8 *req_authenticator)
     496             : {
     497             :         const u8 *addr[2];
     498             :         size_t len[2];
     499             : 
     500         488 :         msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
     501         488 :         os_memcpy(msg->hdr->authenticator, req_authenticator, MD5_MAC_LEN);
     502         488 :         addr[0] = wpabuf_head(msg->buf);
     503         488 :         len[0] = wpabuf_len(msg->buf);
     504         488 :         addr[1] = secret;
     505         488 :         len[1] = secret_len;
     506         488 :         md5_vector(2, addr, len, msg->hdr->authenticator);
     507             : 
     508         488 :         if (wpabuf_len(msg->buf) > 0xffff) {
     509           0 :                 wpa_printf(MSG_WARNING, "RADIUS: Too long messages (%lu)",
     510           0 :                            (unsigned long) wpabuf_len(msg->buf));
     511             :         }
     512         488 : }
     513             : 
     514             : 
     515         489 : int radius_msg_verify_acct_req(struct radius_msg *msg, const u8 *secret,
     516             :                                size_t secret_len)
     517             : {
     518             :         const u8 *addr[4];
     519             :         size_t len[4];
     520             :         u8 zero[MD5_MAC_LEN];
     521             :         u8 hash[MD5_MAC_LEN];
     522             : 
     523         489 :         os_memset(zero, 0, sizeof(zero));
     524         489 :         addr[0] = (u8 *) msg->hdr;
     525         489 :         len[0] = sizeof(struct radius_hdr) - MD5_MAC_LEN;
     526         489 :         addr[1] = zero;
     527         489 :         len[1] = MD5_MAC_LEN;
     528         489 :         addr[2] = (u8 *) (msg->hdr + 1);
     529         489 :         len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
     530         489 :         addr[3] = secret;
     531         489 :         len[3] = secret_len;
     532         489 :         md5_vector(4, addr, len, hash);
     533         489 :         return os_memcmp_const(msg->hdr->authenticator, hash, MD5_MAC_LEN) != 0;
     534             : }
     535             : 
     536             : 
     537          28 : int radius_msg_verify_das_req(struct radius_msg *msg, const u8 *secret,
     538             :                               size_t secret_len)
     539             : {
     540             :         const u8 *addr[4];
     541             :         size_t len[4];
     542             :         u8 zero[MD5_MAC_LEN];
     543             :         u8 hash[MD5_MAC_LEN];
     544             :         u8 auth[MD5_MAC_LEN], orig[MD5_MAC_LEN];
     545             :         u8 orig_authenticator[16];
     546             : 
     547          28 :         struct radius_attr_hdr *attr = NULL, *tmp;
     548             :         size_t i;
     549             : 
     550          28 :         os_memset(zero, 0, sizeof(zero));
     551          28 :         addr[0] = (u8 *) msg->hdr;
     552          28 :         len[0] = sizeof(struct radius_hdr) - MD5_MAC_LEN;
     553          28 :         addr[1] = zero;
     554          28 :         len[1] = MD5_MAC_LEN;
     555          28 :         addr[2] = (u8 *) (msg->hdr + 1);
     556          28 :         len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
     557          28 :         addr[3] = secret;
     558          28 :         len[3] = secret_len;
     559          28 :         md5_vector(4, addr, len, hash);
     560          28 :         if (os_memcmp_const(msg->hdr->authenticator, hash, MD5_MAC_LEN) != 0)
     561           1 :                 return 1;
     562             : 
     563         103 :         for (i = 0; i < msg->attr_used; i++) {
     564          76 :                 tmp = radius_get_attr_hdr(msg, i);
     565          76 :                 if (tmp->type == RADIUS_ATTR_MESSAGE_AUTHENTICATOR) {
     566           0 :                         if (attr != NULL) {
     567           0 :                                 wpa_printf(MSG_WARNING, "Multiple "
     568             :                                            "Message-Authenticator attributes "
     569             :                                            "in RADIUS message");
     570           0 :                                 return 1;
     571             :                         }
     572           0 :                         attr = tmp;
     573             :                 }
     574             :         }
     575             : 
     576          27 :         if (attr == NULL) {
     577             :                 /* Message-Authenticator is MAY; not required */
     578          27 :                 return 0;
     579             :         }
     580             : 
     581           0 :         os_memcpy(orig, attr + 1, MD5_MAC_LEN);
     582           0 :         os_memset(attr + 1, 0, MD5_MAC_LEN);
     583           0 :         os_memcpy(orig_authenticator, msg->hdr->authenticator,
     584             :                   sizeof(orig_authenticator));
     585           0 :         os_memset(msg->hdr->authenticator, 0,
     586             :                   sizeof(msg->hdr->authenticator));
     587           0 :         hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
     588           0 :                  wpabuf_len(msg->buf), auth);
     589           0 :         os_memcpy(attr + 1, orig, MD5_MAC_LEN);
     590           0 :         os_memcpy(msg->hdr->authenticator, orig_authenticator,
     591             :                   sizeof(orig_authenticator));
     592             : 
     593           0 :         return os_memcmp_const(orig, auth, MD5_MAC_LEN) != 0;
     594             : }
     595             : 
     596             : 
     597      148078 : static int radius_msg_add_attr_to_array(struct radius_msg *msg,
     598             :                                         struct radius_attr_hdr *attr)
     599             : {
     600      148078 :         if (msg->attr_used >= msg->attr_size) {
     601             :                 size_t *nattr_pos;
     602        1556 :                 int nlen = msg->attr_size * 2;
     603             : 
     604        1556 :                 nattr_pos = os_realloc_array(msg->attr_pos, nlen,
     605             :                                              sizeof(*msg->attr_pos));
     606        1556 :                 if (nattr_pos == NULL)
     607           0 :                         return -1;
     608             : 
     609        1556 :                 msg->attr_pos = nattr_pos;
     610        1556 :                 msg->attr_size = nlen;
     611             :         }
     612             : 
     613      296156 :         msg->attr_pos[msg->attr_used++] =
     614      148078 :                 (unsigned char *) attr - wpabuf_head_u8(msg->buf);
     615             : 
     616      148078 :         return 0;
     617             : }
     618             : 
     619             : 
     620       77249 : struct radius_attr_hdr *radius_msg_add_attr(struct radius_msg *msg, u8 type,
     621             :                                             const u8 *data, size_t data_len)
     622             : {
     623             :         size_t buf_needed;
     624             :         struct radius_attr_hdr *attr;
     625             : 
     626       77249 :         if (data_len > RADIUS_MAX_ATTR_LEN) {
     627           0 :                 wpa_printf(MSG_ERROR, "radius_msg_add_attr: too long attribute (%lu bytes)",
     628             :                        (unsigned long) data_len);
     629           0 :                 return NULL;
     630             :         }
     631             : 
     632       77249 :         buf_needed = sizeof(*attr) + data_len;
     633             : 
     634       77249 :         if (wpabuf_tailroom(msg->buf) < buf_needed) {
     635             :                 /* allocate more space for message buffer */
     636        1058 :                 if (wpabuf_resize(&msg->buf, buf_needed) < 0)
     637           0 :                         return NULL;
     638        1058 :                 msg->hdr = wpabuf_mhead(msg->buf);
     639             :         }
     640             : 
     641       77249 :         attr = wpabuf_put(msg->buf, sizeof(struct radius_attr_hdr));
     642       77249 :         attr->type = type;
     643       77249 :         attr->length = sizeof(*attr) + data_len;
     644       77249 :         wpabuf_put_data(msg->buf, data, data_len);
     645             : 
     646       77249 :         if (radius_msg_add_attr_to_array(msg, attr))
     647           0 :                 return NULL;
     648             : 
     649       77249 :         return attr;
     650             : }
     651             : 
     652             : 
     653             : /**
     654             :  * radius_msg_parse - Parse a RADIUS message
     655             :  * @data: RADIUS message to be parsed
     656             :  * @len: Length of data buffer in octets
     657             :  * Returns: Parsed RADIUS message or %NULL on failure
     658             :  *
     659             :  * This parses a RADIUS message and makes a copy of its data. The caller is
     660             :  * responsible for freeing the returned data with radius_msg_free().
     661             :  */
     662        8036 : struct radius_msg * radius_msg_parse(const u8 *data, size_t len)
     663             : {
     664             :         struct radius_msg *msg;
     665             :         struct radius_hdr *hdr;
     666             :         struct radius_attr_hdr *attr;
     667             :         size_t msg_len;
     668             :         unsigned char *pos, *end;
     669             : 
     670        8036 :         if (data == NULL || len < sizeof(*hdr))
     671           0 :                 return NULL;
     672             : 
     673        8036 :         hdr = (struct radius_hdr *) data;
     674             : 
     675        8036 :         msg_len = be_to_host16(hdr->length);
     676        8036 :         if (msg_len < sizeof(*hdr) || msg_len > len) {
     677           0 :                 wpa_printf(MSG_INFO, "RADIUS: Invalid message length");
     678           0 :                 return NULL;
     679             :         }
     680             : 
     681        8036 :         if (msg_len < len) {
     682           0 :                 wpa_printf(MSG_DEBUG, "RADIUS: Ignored %lu extra bytes after "
     683             :                            "RADIUS message", (unsigned long) len - msg_len);
     684             :         }
     685             : 
     686        8036 :         msg = os_zalloc(sizeof(*msg));
     687        8036 :         if (msg == NULL)
     688           8 :                 return NULL;
     689             : 
     690        8028 :         msg->buf = wpabuf_alloc_copy(data, msg_len);
     691        8028 :         if (msg->buf == NULL || radius_msg_initialize(msg)) {
     692           9 :                 radius_msg_free(msg);
     693           9 :                 return NULL;
     694             :         }
     695        8019 :         msg->hdr = wpabuf_mhead(msg->buf);
     696             : 
     697             :         /* parse attributes */
     698        8019 :         pos = wpabuf_mhead_u8(msg->buf) + sizeof(struct radius_hdr);
     699        8019 :         end = wpabuf_mhead_u8(msg->buf) + wpabuf_len(msg->buf);
     700       86867 :         while (pos < end) {
     701       70829 :                 if ((size_t) (end - pos) < sizeof(*attr))
     702           0 :                         goto fail;
     703             : 
     704       70829 :                 attr = (struct radius_attr_hdr *) pos;
     705             : 
     706       70829 :                 if (pos + attr->length > end || attr->length < sizeof(*attr))
     707             :                         goto fail;
     708             : 
     709             :                 /* TODO: check that attr->length is suitable for attr->type */
     710             : 
     711       70829 :                 if (radius_msg_add_attr_to_array(msg, attr))
     712           0 :                         goto fail;
     713             : 
     714       70829 :                 pos += attr->length;
     715             :         }
     716             : 
     717        8019 :         return msg;
     718             : 
     719             :  fail:
     720           0 :         radius_msg_free(msg);
     721           0 :         return NULL;
     722             : }
     723             : 
     724             : 
     725        7055 : int radius_msg_add_eap(struct radius_msg *msg, const u8 *data, size_t data_len)
     726             : {
     727        7055 :         const u8 *pos = data;
     728        7055 :         size_t left = data_len;
     729             : 
     730       22957 :         while (left > 0) {
     731             :                 int len;
     732        8847 :                 if (left > RADIUS_MAX_ATTR_LEN)
     733        1792 :                         len = RADIUS_MAX_ATTR_LEN;
     734             :                 else
     735        7055 :                         len = left;
     736             : 
     737        8847 :                 if (!radius_msg_add_attr(msg, RADIUS_ATTR_EAP_MESSAGE,
     738             :                                          pos, len))
     739           0 :                         return 0;
     740             : 
     741        8847 :                 pos += len;
     742        8847 :                 left -= len;
     743             :         }
     744             : 
     745        7055 :         return 1;
     746             : }
     747             : 
     748             : 
     749        7131 : struct wpabuf * radius_msg_get_eap(struct radius_msg *msg)
     750             : {
     751             :         struct wpabuf *eap;
     752             :         size_t len, i;
     753             :         struct radius_attr_hdr *attr;
     754             : 
     755        7131 :         if (msg == NULL)
     756           0 :                 return NULL;
     757             : 
     758        7131 :         len = 0;
     759       71584 :         for (i = 0; i < msg->attr_used; i++) {
     760       64453 :                 attr = radius_get_attr_hdr(msg, i);
     761       73363 :                 if (attr->type == RADIUS_ATTR_EAP_MESSAGE &&
     762        8910 :                     attr->length > sizeof(struct radius_attr_hdr))
     763        8910 :                         len += attr->length - sizeof(struct radius_attr_hdr);
     764             :         }
     765             : 
     766        7131 :         if (len == 0)
     767          20 :                 return NULL;
     768             : 
     769        7111 :         eap = wpabuf_alloc(len);
     770        7111 :         if (eap == NULL)
     771           3 :                 return NULL;
     772             : 
     773       71501 :         for (i = 0; i < msg->attr_used; i++) {
     774       64393 :                 attr = radius_get_attr_hdr(msg, i);
     775       73300 :                 if (attr->type == RADIUS_ATTR_EAP_MESSAGE &&
     776        8907 :                     attr->length > sizeof(struct radius_attr_hdr)) {
     777        8907 :                         int flen = attr->length - sizeof(*attr);
     778        8907 :                         wpabuf_put_data(eap, attr + 1, flen);
     779             :                 }
     780             :         }
     781             : 
     782        7108 :         return eap;
     783             : }
     784             : 
     785             : 
     786        7055 : int radius_msg_verify_msg_auth(struct radius_msg *msg, const u8 *secret,
     787             :                                size_t secret_len, const u8 *req_auth)
     788             : {
     789             :         u8 auth[MD5_MAC_LEN], orig[MD5_MAC_LEN];
     790             :         u8 orig_authenticator[16];
     791        7055 :         struct radius_attr_hdr *attr = NULL, *tmp;
     792             :         size_t i;
     793             : 
     794       70286 :         for (i = 0; i < msg->attr_used; i++) {
     795       63232 :                 tmp = radius_get_attr_hdr(msg, i);
     796       63232 :                 if (tmp->type == RADIUS_ATTR_MESSAGE_AUTHENTICATOR) {
     797        7055 :                         if (attr != NULL) {
     798           1 :                                 wpa_printf(MSG_INFO, "Multiple Message-Authenticator attributes in RADIUS message");
     799           1 :                                 return 1;
     800             :                         }
     801        7054 :                         attr = tmp;
     802             :                 }
     803             :         }
     804             : 
     805        7054 :         if (attr == NULL) {
     806           1 :                 wpa_printf(MSG_INFO, "No Message-Authenticator attribute found");
     807           1 :                 return 1;
     808             :         }
     809             : 
     810        7053 :         os_memcpy(orig, attr + 1, MD5_MAC_LEN);
     811        7053 :         os_memset(attr + 1, 0, MD5_MAC_LEN);
     812        7053 :         if (req_auth) {
     813        3744 :                 os_memcpy(orig_authenticator, msg->hdr->authenticator,
     814             :                           sizeof(orig_authenticator));
     815        3744 :                 os_memcpy(msg->hdr->authenticator, req_auth,
     816             :                           sizeof(msg->hdr->authenticator));
     817             :         }
     818        7053 :         hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
     819        7053 :                  wpabuf_len(msg->buf), auth);
     820        7053 :         os_memcpy(attr + 1, orig, MD5_MAC_LEN);
     821        7053 :         if (req_auth) {
     822        3744 :                 os_memcpy(msg->hdr->authenticator, orig_authenticator,
     823             :                           sizeof(orig_authenticator));
     824             :         }
     825             : 
     826        7053 :         if (os_memcmp_const(orig, auth, MD5_MAC_LEN) != 0) {
     827           2 :                 wpa_printf(MSG_INFO, "Invalid Message-Authenticator!");
     828           2 :                 return 1;
     829             :         }
     830             : 
     831        7051 :         return 0;
     832             : }
     833             : 
     834             : 
     835        4184 : int radius_msg_verify(struct radius_msg *msg, const u8 *secret,
     836             :                       size_t secret_len, struct radius_msg *sent_msg, int auth)
     837             : {
     838             :         const u8 *addr[4];
     839             :         size_t len[4];
     840             :         u8 hash[MD5_MAC_LEN];
     841             : 
     842        4184 :         if (sent_msg == NULL) {
     843           0 :                 wpa_printf(MSG_INFO, "No matching Access-Request message found");
     844           0 :                 return 1;
     845             :         }
     846             : 
     847        7930 :         if (auth &&
     848        3746 :             radius_msg_verify_msg_auth(msg, secret, secret_len,
     849        3746 :                                        sent_msg->hdr->authenticator)) {
     850           3 :                 return 1;
     851             :         }
     852             : 
     853             :         /* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
     854        4181 :         addr[0] = (u8 *) msg->hdr;
     855        4181 :         len[0] = 1 + 1 + 2;
     856        4181 :         addr[1] = sent_msg->hdr->authenticator;
     857        4181 :         len[1] = MD5_MAC_LEN;
     858        4181 :         addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
     859        4181 :         len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
     860        4181 :         addr[3] = secret;
     861        4181 :         len[3] = secret_len;
     862        4181 :         md5_vector(4, addr, len, hash);
     863        4181 :         if (os_memcmp_const(hash, msg->hdr->authenticator, MD5_MAC_LEN) != 0) {
     864           0 :                 wpa_printf(MSG_INFO, "Response Authenticator invalid!");
     865           0 :                 return 1;
     866             :         }
     867             : 
     868        4181 :         return 0;
     869             : }
     870             : 
     871             : 
     872        5994 : int radius_msg_copy_attr(struct radius_msg *dst, struct radius_msg *src,
     873             :                          u8 type)
     874             : {
     875             :         struct radius_attr_hdr *attr;
     876             :         size_t i;
     877        5994 :         int count = 0;
     878             : 
     879       65545 :         for (i = 0; i < src->attr_used; i++) {
     880       59551 :                 attr = radius_get_attr_hdr(src, i);
     881       59551 :                 if (attr->type == type && attr->length >= sizeof(*attr)) {
     882        2486 :                         if (!radius_msg_add_attr(dst, type, (u8 *) (attr + 1),
     883        2486 :                                                  attr->length - sizeof(*attr)))
     884           0 :                                 return -1;
     885        2486 :                         count++;
     886             :                 }
     887             :         }
     888             : 
     889        5994 :         return count;
     890             : }
     891             : 
     892             : 
     893             : /* Create Request Authenticator. The value should be unique over the lifetime
     894             :  * of the shared secret between authenticator and authentication server.
     895             :  * Use one-way MD5 hash calculated from current timestamp and some data given
     896             :  * by the caller. */
     897        4319 : void radius_msg_make_authenticator(struct radius_msg *msg,
     898             :                                    const u8 *data, size_t len)
     899             : {
     900             :         struct os_time tv;
     901             :         long int l;
     902             :         const u8 *addr[3];
     903             :         size_t elen[3];
     904             : 
     905        4319 :         os_get_time(&tv);
     906        4319 :         l = os_random();
     907        4319 :         addr[0] = (u8 *) &tv;
     908        4319 :         elen[0] = sizeof(tv);
     909        4319 :         addr[1] = data;
     910        4319 :         elen[1] = len;
     911        4319 :         addr[2] = (u8 *) &l;
     912        4319 :         elen[2] = sizeof(l);
     913        4319 :         md5_vector(3, addr, elen, msg->hdr->authenticator);
     914        4319 : }
     915             : 
     916             : 
     917             : /* Get Vendor-specific RADIUS Attribute from a parsed RADIUS message.
     918             :  * Returns the Attribute payload and sets alen to indicate the length of the
     919             :  * payload if a vendor attribute with subtype is found, otherwise returns NULL.
     920             :  * The returned payload is allocated with os_malloc() and caller must free it
     921             :  * by calling os_free().
     922             :  */
     923        1332 : static u8 *radius_msg_get_vendor_attr(struct radius_msg *msg, u32 vendor,
     924             :                                       u8 subtype, size_t *alen)
     925             : {
     926             :         u8 *data, *pos;
     927             :         size_t i, len;
     928             : 
     929        1332 :         if (msg == NULL)
     930           0 :                 return NULL;
     931             : 
     932        3326 :         for (i = 0; i < msg->attr_used; i++) {
     933        3318 :                 struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
     934             :                 size_t left;
     935             :                 u32 vendor_id;
     936             :                 struct radius_attr_vendor *vhdr;
     937             : 
     938        5304 :                 if (attr->type != RADIUS_ATTR_VENDOR_SPECIFIC ||
     939        1986 :                     attr->length < sizeof(*attr))
     940        2664 :                         continue;
     941             : 
     942        1986 :                 left = attr->length - sizeof(*attr);
     943        1986 :                 if (left < 4)
     944           0 :                         continue;
     945             : 
     946        1986 :                 pos = (u8 *) (attr + 1);
     947             : 
     948        1986 :                 os_memcpy(&vendor_id, pos, 4);
     949        1986 :                 pos += 4;
     950        1986 :                 left -= 4;
     951             : 
     952        1986 :                 if (ntohl(vendor_id) != vendor)
     953           0 :                         continue;
     954             : 
     955        4634 :                 while (left >= sizeof(*vhdr)) {
     956        1986 :                         vhdr = (struct radius_attr_vendor *) pos;
     957        3972 :                         if (vhdr->vendor_length > left ||
     958        1986 :                             vhdr->vendor_length < sizeof(*vhdr)) {
     959             :                                 break;
     960             :                         }
     961        1986 :                         if (vhdr->vendor_type != subtype) {
     962         662 :                                 pos += vhdr->vendor_length;
     963         662 :                                 left -= vhdr->vendor_length;
     964         662 :                                 continue;
     965             :                         }
     966             : 
     967        1324 :                         len = vhdr->vendor_length - sizeof(*vhdr);
     968        1324 :                         data = os_malloc(len);
     969        1324 :                         if (data == NULL)
     970        1327 :                                 return NULL;
     971        1321 :                         os_memcpy(data, pos + sizeof(*vhdr), len);
     972        1321 :                         if (alen)
     973        1321 :                                 *alen = len;
     974        1321 :                         return data;
     975             :                 }
     976             :         }
     977             : 
     978           8 :         return NULL;
     979             : }
     980             : 
     981             : 
     982        1321 : static u8 * decrypt_ms_key(const u8 *key, size_t len,
     983             :                            const u8 *req_authenticator,
     984             :                            const u8 *secret, size_t secret_len, size_t *reslen)
     985             : {
     986             :         u8 *plain, *ppos, *res;
     987             :         const u8 *pos;
     988             :         size_t left, plen;
     989             :         u8 hash[MD5_MAC_LEN];
     990        1321 :         int i, first = 1;
     991             :         const u8 *addr[3];
     992             :         size_t elen[3];
     993             : 
     994             :         /* key: 16-bit salt followed by encrypted key info */
     995             : 
     996        1321 :         if (len < 2 + 16) {
     997           0 :                 wpa_printf(MSG_DEBUG, "RADIUS: %s: Len is too small: %d",
     998             :                            __func__, (int) len);
     999           0 :                 return NULL;
    1000             :         }
    1001             : 
    1002        1321 :         pos = key + 2;
    1003        1321 :         left = len - 2;
    1004        1321 :         if (left % 16) {
    1005           0 :                 wpa_printf(MSG_INFO, "RADIUS: Invalid ms key len %lu",
    1006             :                            (unsigned long) left);
    1007           0 :                 return NULL;
    1008             :         }
    1009             : 
    1010        1321 :         plen = left;
    1011        1321 :         ppos = plain = os_malloc(plen);
    1012        1321 :         if (plain == NULL)
    1013           2 :                 return NULL;
    1014        1319 :         plain[0] = 0;
    1015             : 
    1016        6595 :         while (left > 0) {
    1017             :                 /* b(1) = MD5(Secret + Request-Authenticator + Salt)
    1018             :                  * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
    1019             : 
    1020        3957 :                 addr[0] = secret;
    1021        3957 :                 elen[0] = secret_len;
    1022        3957 :                 if (first) {
    1023        1319 :                         addr[1] = req_authenticator;
    1024        1319 :                         elen[1] = MD5_MAC_LEN;
    1025        1319 :                         addr[2] = key;
    1026        1319 :                         elen[2] = 2; /* Salt */
    1027             :                 } else {
    1028        2638 :                         addr[1] = pos - MD5_MAC_LEN;
    1029        2638 :                         elen[1] = MD5_MAC_LEN;
    1030             :                 }
    1031        3957 :                 md5_vector(first ? 3 : 2, addr, elen, hash);
    1032        3957 :                 first = 0;
    1033             : 
    1034       67269 :                 for (i = 0; i < MD5_MAC_LEN; i++)
    1035       63312 :                         *ppos++ = *pos++ ^ hash[i];
    1036        3957 :                 left -= MD5_MAC_LEN;
    1037             :         }
    1038             : 
    1039        1319 :         if (plain[0] == 0 || plain[0] > plen - 1) {
    1040           0 :                 wpa_printf(MSG_INFO, "RADIUS: Failed to decrypt MPPE key");
    1041           0 :                 os_free(plain);
    1042           0 :                 return NULL;
    1043             :         }
    1044             : 
    1045        1319 :         res = os_malloc(plain[0]);
    1046        1319 :         if (res == NULL) {
    1047           3 :                 os_free(plain);
    1048           3 :                 return NULL;
    1049             :         }
    1050        1316 :         os_memcpy(res, plain + 1, plain[0]);
    1051        1316 :         if (reslen)
    1052        1316 :                 *reslen = plain[0];
    1053        1316 :         os_free(plain);
    1054        1316 :         return res;
    1055             : }
    1056             : 
    1057             : 
    1058        1330 : static void encrypt_ms_key(const u8 *key, size_t key_len, u16 salt,
    1059             :                            const u8 *req_authenticator,
    1060             :                            const u8 *secret, size_t secret_len,
    1061             :                            u8 *ebuf, size_t *elen)
    1062             : {
    1063        1330 :         int i, len, first = 1;
    1064             :         u8 hash[MD5_MAC_LEN], saltbuf[2], *pos;
    1065             :         const u8 *addr[3];
    1066             :         size_t _len[3];
    1067             : 
    1068        1330 :         WPA_PUT_BE16(saltbuf, salt);
    1069             : 
    1070        1330 :         len = 1 + key_len;
    1071        1330 :         if (len & 0x0f) {
    1072        1330 :                 len = (len & 0xf0) + 16;
    1073             :         }
    1074        1330 :         os_memset(ebuf, 0, len);
    1075        1330 :         ebuf[0] = key_len;
    1076        1330 :         os_memcpy(ebuf + 1, key, key_len);
    1077             : 
    1078        1330 :         *elen = len;
    1079             : 
    1080        1330 :         pos = ebuf;
    1081        6650 :         while (len > 0) {
    1082             :                 /* b(1) = MD5(Secret + Request-Authenticator + Salt)
    1083             :                  * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
    1084        3990 :                 addr[0] = secret;
    1085        3990 :                 _len[0] = secret_len;
    1086        3990 :                 if (first) {
    1087        1330 :                         addr[1] = req_authenticator;
    1088        1330 :                         _len[1] = MD5_MAC_LEN;
    1089        1330 :                         addr[2] = saltbuf;
    1090        1330 :                         _len[2] = sizeof(saltbuf);
    1091             :                 } else {
    1092        2660 :                         addr[1] = pos - MD5_MAC_LEN;
    1093        2660 :                         _len[1] = MD5_MAC_LEN;
    1094             :                 }
    1095        3990 :                 md5_vector(first ? 3 : 2, addr, _len, hash);
    1096        3990 :                 first = 0;
    1097             : 
    1098       67830 :                 for (i = 0; i < MD5_MAC_LEN; i++)
    1099       63840 :                         *pos++ ^= hash[i];
    1100             : 
    1101        3990 :                 len -= MD5_MAC_LEN;
    1102             :         }
    1103        1330 : }
    1104             : 
    1105             : 
    1106             : struct radius_ms_mppe_keys *
    1107         667 : radius_msg_get_ms_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
    1108             :                        const u8 *secret, size_t secret_len)
    1109             : {
    1110             :         u8 *key;
    1111             :         size_t keylen;
    1112             :         struct radius_ms_mppe_keys *keys;
    1113             : 
    1114         667 :         if (msg == NULL || sent_msg == NULL)
    1115           0 :                 return NULL;
    1116             : 
    1117         667 :         keys = os_zalloc(sizeof(*keys));
    1118         667 :         if (keys == NULL)
    1119           1 :                 return NULL;
    1120             : 
    1121         666 :         key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
    1122             :                                          RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY,
    1123             :                                          &keylen);
    1124         666 :         if (key) {
    1125        1322 :                 keys->send = decrypt_ms_key(key, keylen,
    1126         661 :                                             sent_msg->hdr->authenticator,
    1127             :                                             secret, secret_len,
    1128             :                                             &keys->send_len);
    1129         661 :                 if (!keys->send) {
    1130           2 :                         wpa_printf(MSG_DEBUG,
    1131             :                                    "RADIUS: Failed to decrypt send key");
    1132             :                 }
    1133         661 :                 os_free(key);
    1134             :         }
    1135             : 
    1136         666 :         key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
    1137             :                                          RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY,
    1138             :                                          &keylen);
    1139         666 :         if (key) {
    1140        1320 :                 keys->recv = decrypt_ms_key(key, keylen,
    1141         660 :                                             sent_msg->hdr->authenticator,
    1142             :                                             secret, secret_len,
    1143             :                                             &keys->recv_len);
    1144         660 :                 if (!keys->recv) {
    1145           3 :                         wpa_printf(MSG_DEBUG,
    1146             :                                    "RADIUS: Failed to decrypt recv key");
    1147             :                 }
    1148         660 :                 os_free(key);
    1149             :         }
    1150             : 
    1151         666 :         return keys;
    1152             : }
    1153             : 
    1154             : 
    1155             : struct radius_ms_mppe_keys *
    1156           0 : radius_msg_get_cisco_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
    1157             :                           const u8 *secret, size_t secret_len)
    1158             : {
    1159             :         u8 *key;
    1160             :         size_t keylen;
    1161             :         struct radius_ms_mppe_keys *keys;
    1162             : 
    1163           0 :         if (msg == NULL || sent_msg == NULL)
    1164           0 :                 return NULL;
    1165             : 
    1166           0 :         keys = os_zalloc(sizeof(*keys));
    1167           0 :         if (keys == NULL)
    1168           0 :                 return NULL;
    1169             : 
    1170           0 :         key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_CISCO,
    1171             :                                          RADIUS_CISCO_AV_PAIR, &keylen);
    1172           0 :         if (key && keylen == 51 &&
    1173           0 :             os_memcmp(key, "leap:session-key=", 17) == 0) {
    1174           0 :                 keys->recv = decrypt_ms_key(key + 17, keylen - 17,
    1175           0 :                                             sent_msg->hdr->authenticator,
    1176             :                                             secret, secret_len,
    1177             :                                             &keys->recv_len);
    1178             :         }
    1179           0 :         os_free(key);
    1180             : 
    1181           0 :         return keys;
    1182             : }
    1183             : 
    1184             : 
    1185         665 : int radius_msg_add_mppe_keys(struct radius_msg *msg,
    1186             :                              const u8 *req_authenticator,
    1187             :                              const u8 *secret, size_t secret_len,
    1188             :                              const u8 *send_key, size_t send_key_len,
    1189             :                              const u8 *recv_key, size_t recv_key_len)
    1190             : {
    1191             :         struct radius_attr_hdr *attr;
    1192         665 :         u32 vendor_id = htonl(RADIUS_VENDOR_ID_MICROSOFT);
    1193             :         u8 *buf;
    1194             :         struct radius_attr_vendor *vhdr;
    1195             :         u8 *pos;
    1196             :         size_t elen;
    1197             :         int hlen;
    1198             :         u16 salt;
    1199             : 
    1200         665 :         hlen = sizeof(vendor_id) + sizeof(*vhdr) + 2;
    1201             : 
    1202             :         /* MS-MPPE-Send-Key */
    1203         665 :         buf = os_malloc(hlen + send_key_len + 16);
    1204         665 :         if (buf == NULL) {
    1205           0 :                 return 0;
    1206             :         }
    1207         665 :         pos = buf;
    1208         665 :         os_memcpy(pos, &vendor_id, sizeof(vendor_id));
    1209         665 :         pos += sizeof(vendor_id);
    1210         665 :         vhdr = (struct radius_attr_vendor *) pos;
    1211         665 :         vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY;
    1212         665 :         pos = (u8 *) (vhdr + 1);
    1213         665 :         salt = os_random() | 0x8000;
    1214         665 :         WPA_PUT_BE16(pos, salt);
    1215         665 :         pos += 2;
    1216         665 :         encrypt_ms_key(send_key, send_key_len, salt, req_authenticator, secret,
    1217             :                        secret_len, pos, &elen);
    1218         665 :         vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
    1219             : 
    1220         665 :         attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
    1221             :                                    buf, hlen + elen);
    1222         665 :         os_free(buf);
    1223         665 :         if (attr == NULL) {
    1224           0 :                 return 0;
    1225             :         }
    1226             : 
    1227             :         /* MS-MPPE-Recv-Key */
    1228         665 :         buf = os_malloc(hlen + recv_key_len + 16);
    1229         665 :         if (buf == NULL) {
    1230           0 :                 return 0;
    1231             :         }
    1232         665 :         pos = buf;
    1233         665 :         os_memcpy(pos, &vendor_id, sizeof(vendor_id));
    1234         665 :         pos += sizeof(vendor_id);
    1235         665 :         vhdr = (struct radius_attr_vendor *) pos;
    1236         665 :         vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY;
    1237         665 :         pos = (u8 *) (vhdr + 1);
    1238         665 :         salt ^= 1;
    1239         665 :         WPA_PUT_BE16(pos, salt);
    1240         665 :         pos += 2;
    1241         665 :         encrypt_ms_key(recv_key, recv_key_len, salt, req_authenticator, secret,
    1242             :                        secret_len, pos, &elen);
    1243         665 :         vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
    1244             : 
    1245         665 :         attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
    1246             :                                    buf, hlen + elen);
    1247         665 :         os_free(buf);
    1248         665 :         if (attr == NULL) {
    1249           0 :                 return 0;
    1250             :         }
    1251             : 
    1252         665 :         return 1;
    1253             : }
    1254             : 
    1255             : 
    1256        1167 : int radius_msg_add_wfa(struct radius_msg *msg, u8 subtype, const u8 *data,
    1257             :                        size_t len)
    1258             : {
    1259             :         struct radius_attr_hdr *attr;
    1260             :         u8 *buf, *pos;
    1261             :         size_t alen;
    1262             : 
    1263        1167 :         alen = 4 + 2 + len;
    1264        1167 :         buf = os_malloc(alen);
    1265        1167 :         if (buf == NULL)
    1266           0 :                 return 0;
    1267        1167 :         pos = buf;
    1268        1167 :         WPA_PUT_BE32(pos, RADIUS_VENDOR_ID_WFA);
    1269        1167 :         pos += 4;
    1270        1167 :         *pos++ = subtype;
    1271        1167 :         *pos++ = 2 + len;
    1272        1167 :         os_memcpy(pos, data, len);
    1273        1167 :         attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
    1274             :                                    buf, alen);
    1275        1167 :         os_free(buf);
    1276        1167 :         if (attr == NULL)
    1277           0 :                 return 0;
    1278             : 
    1279        1167 :         return 1;
    1280             : }
    1281             : 
    1282             : 
    1283          13 : int radius_user_password_hide(struct radius_msg *msg,
    1284             :                               const u8 *data, size_t data_len,
    1285             :                               const u8 *secret, size_t secret_len,
    1286             :                               u8 *buf, size_t buf_len)
    1287             : {
    1288             :         size_t padlen, i, pos;
    1289             :         const u8 *addr[2];
    1290             :         size_t len[2];
    1291             :         u8 hash[16];
    1292             : 
    1293          13 :         if (data_len + 16 > buf_len)
    1294           0 :                 return -1;
    1295             : 
    1296          13 :         os_memcpy(buf, data, data_len);
    1297             : 
    1298          13 :         padlen = data_len % 16;
    1299          13 :         if (padlen && data_len < buf_len) {
    1300          13 :                 padlen = 16 - padlen;
    1301          13 :                 os_memset(buf + data_len, 0, padlen);
    1302          13 :                 buf_len = data_len + padlen;
    1303             :         } else {
    1304           0 :                 buf_len = data_len;
    1305             :         }
    1306             : 
    1307          13 :         addr[0] = secret;
    1308          13 :         len[0] = secret_len;
    1309          13 :         addr[1] = msg->hdr->authenticator;
    1310          13 :         len[1] = 16;
    1311          13 :         md5_vector(2, addr, len, hash);
    1312             : 
    1313         221 :         for (i = 0; i < 16; i++)
    1314         208 :                 buf[i] ^= hash[i];
    1315          13 :         pos = 16;
    1316             : 
    1317          26 :         while (pos < buf_len) {
    1318           0 :                 addr[0] = secret;
    1319           0 :                 len[0] = secret_len;
    1320           0 :                 addr[1] = &buf[pos - 16];
    1321           0 :                 len[1] = 16;
    1322           0 :                 md5_vector(2, addr, len, hash);
    1323             : 
    1324           0 :                 for (i = 0; i < 16; i++)
    1325           0 :                         buf[pos + i] ^= hash[i];
    1326             : 
    1327           0 :                 pos += 16;
    1328             :         }
    1329             : 
    1330          13 :         return buf_len;
    1331             : }
    1332             : 
    1333             : 
    1334             : /* Add User-Password attribute to a RADIUS message and encrypt it as specified
    1335             :  * in RFC 2865, Chap. 5.2 */
    1336             : struct radius_attr_hdr *
    1337           9 : radius_msg_add_attr_user_password(struct radius_msg *msg,
    1338             :                                   const u8 *data, size_t data_len,
    1339             :                                   const u8 *secret, size_t secret_len)
    1340             : {
    1341             :         u8 buf[128];
    1342             :         int res;
    1343             : 
    1344           9 :         res = radius_user_password_hide(msg, data, data_len,
    1345             :                                         secret, secret_len, buf, sizeof(buf));
    1346           9 :         if (res < 0)
    1347           0 :                 return NULL;
    1348             : 
    1349           9 :         return radius_msg_add_attr(msg, RADIUS_ATTR_USER_PASSWORD,
    1350             :                                    buf, res);
    1351             : }
    1352             : 
    1353             : 
    1354       11607 : int radius_msg_get_attr(struct radius_msg *msg, u8 type, u8 *buf, size_t len)
    1355             : {
    1356       11607 :         struct radius_attr_hdr *attr = NULL, *tmp;
    1357             :         size_t i, dlen;
    1358             : 
    1359       84520 :         for (i = 0; i < msg->attr_used; i++) {
    1360       75546 :                 tmp = radius_get_attr_hdr(msg, i);
    1361       75546 :                 if (tmp->type == type) {
    1362        2633 :                         attr = tmp;
    1363        2633 :                         break;
    1364             :                 }
    1365             :         }
    1366             : 
    1367       11607 :         if (!attr || attr->length < sizeof(*attr))
    1368        8974 :                 return -1;
    1369             : 
    1370        2633 :         dlen = attr->length - sizeof(*attr);
    1371        2633 :         if (buf)
    1372        2531 :                 os_memcpy(buf, (attr + 1), dlen > len ? len : dlen);
    1373        2633 :         return dlen;
    1374             : }
    1375             : 
    1376             : 
    1377        4350 : int radius_msg_get_attr_ptr(struct radius_msg *msg, u8 type, u8 **buf,
    1378             :                             size_t *len, const u8 *start)
    1379             : {
    1380             :         size_t i;
    1381        4350 :         struct radius_attr_hdr *attr = NULL, *tmp;
    1382             : 
    1383       14952 :         for (i = 0; i < msg->attr_used; i++) {
    1384       12808 :                 tmp = radius_get_attr_hdr(msg, i);
    1385       12808 :                 if (tmp->type == type &&
    1386        2668 :                     (start == NULL || (u8 *) tmp > start)) {
    1387        2206 :                         attr = tmp;
    1388        2206 :                         break;
    1389             :                 }
    1390             :         }
    1391             : 
    1392        4350 :         if (!attr || attr->length < sizeof(*attr))
    1393        2144 :                 return -1;
    1394             : 
    1395        2206 :         *buf = (u8 *) (attr + 1);
    1396        2206 :         *len = attr->length - sizeof(*attr);
    1397        2206 :         return 0;
    1398             : }
    1399             : 
    1400             : 
    1401         225 : int radius_msg_count_attr(struct radius_msg *msg, u8 type, int min_len)
    1402             : {
    1403             :         size_t i;
    1404             :         int count;
    1405             : 
    1406        1133 :         for (count = 0, i = 0; i < msg->attr_used; i++) {
    1407         908 :                 struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
    1408         913 :                 if (attr->type == type &&
    1409           5 :                     attr->length >= sizeof(struct radius_attr_hdr) + min_len)
    1410           5 :                         count++;
    1411             :         }
    1412             : 
    1413         225 :         return count;
    1414             : }
    1415             : 
    1416             : 
    1417             : struct radius_tunnel_attrs {
    1418             :         int tag_used;
    1419             :         int type; /* Tunnel-Type */
    1420             :         int medium_type; /* Tunnel-Medium-Type */
    1421             :         int vlanid;
    1422             : };
    1423             : 
    1424             : 
    1425             : /**
    1426             :  * radius_msg_get_vlanid - Parse RADIUS attributes for VLAN tunnel information
    1427             :  * @msg: RADIUS message
    1428             :  * Returns: VLAN ID for the first tunnel configuration or 0 if none is found
    1429             :  */
    1430          25 : int radius_msg_get_vlanid(struct radius_msg *msg)
    1431             : {
    1432             :         struct radius_tunnel_attrs tunnel[RADIUS_TUNNEL_TAGS], *tun;
    1433             :         size_t i;
    1434          25 :         struct radius_attr_hdr *attr = NULL;
    1435             :         const u8 *data;
    1436             :         char buf[10];
    1437             :         size_t dlen;
    1438             : 
    1439          25 :         os_memset(&tunnel, 0, sizeof(tunnel));
    1440             : 
    1441         140 :         for (i = 0; i < msg->attr_used; i++) {
    1442         115 :                 attr = radius_get_attr_hdr(msg, i);
    1443         115 :                 if (attr->length < sizeof(*attr))
    1444           0 :                         return -1;
    1445         115 :                 data = (const u8 *) (attr + 1);
    1446         115 :                 dlen = attr->length - sizeof(*attr);
    1447         115 :                 if (attr->length < 3)
    1448           0 :                         continue;
    1449         115 :                 if (data[0] >= RADIUS_TUNNEL_TAGS)
    1450          37 :                         tun = &tunnel[0];
    1451             :                 else
    1452          78 :                         tun = &tunnel[data[0]];
    1453             : 
    1454         115 :                 switch (attr->type) {
    1455             :                 case RADIUS_ATTR_TUNNEL_TYPE:
    1456          13 :                         if (attr->length != 6)
    1457           0 :                                 break;
    1458          13 :                         tun->tag_used++;
    1459          13 :                         tun->type = WPA_GET_BE24(data + 1);
    1460          13 :                         break;
    1461             :                 case RADIUS_ATTR_TUNNEL_MEDIUM_TYPE:
    1462          13 :                         if (attr->length != 6)
    1463           0 :                                 break;
    1464          13 :                         tun->tag_used++;
    1465          13 :                         tun->medium_type = WPA_GET_BE24(data + 1);
    1466          13 :                         break;
    1467             :                 case RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID:
    1468          13 :                         if (data[0] < RADIUS_TUNNEL_TAGS) {
    1469           0 :                                 data++;
    1470           0 :                                 dlen--;
    1471             :                         }
    1472          13 :                         if (dlen >= sizeof(buf))
    1473           0 :                                 break;
    1474          13 :                         os_memcpy(buf, data, dlen);
    1475          13 :                         buf[dlen] = '\0';
    1476          13 :                         tun->tag_used++;
    1477          13 :                         tun->vlanid = atoi(buf);
    1478          13 :                         break;
    1479             :                 }
    1480             :         }
    1481             : 
    1482         409 :         for (i = 0; i < RADIUS_TUNNEL_TAGS; i++) {
    1483         397 :                 tun = &tunnel[i];
    1484         410 :                 if (tun->tag_used &&
    1485          26 :                     tun->type == RADIUS_TUNNEL_TYPE_VLAN &&
    1486          26 :                     tun->medium_type == RADIUS_TUNNEL_MEDIUM_TYPE_802 &&
    1487          13 :                     tun->vlanid > 0)
    1488          13 :                         return tun->vlanid;
    1489             :         }
    1490             : 
    1491          12 :         return 0;
    1492             : }
    1493             : 
    1494             : 
    1495             : /**
    1496             :  * radius_msg_get_tunnel_password - Parse RADIUS attribute Tunnel-Password
    1497             :  * @msg: Received RADIUS message
    1498             :  * @keylen: Length of returned password
    1499             :  * @secret: RADIUS shared secret
    1500             :  * @secret_len: Length of secret
    1501             :  * @sent_msg: Sent RADIUS message
    1502             :  * @n: Number of password attribute to return (starting with 0)
    1503             :  * Returns: Pointer to n-th password (free with os_free) or %NULL
    1504             :  */
    1505          11 : char * radius_msg_get_tunnel_password(struct radius_msg *msg, int *keylen,
    1506             :                                       const u8 *secret, size_t secret_len,
    1507             :                                       struct radius_msg *sent_msg, size_t n)
    1508             : {
    1509          11 :         u8 *buf = NULL;
    1510             :         size_t buflen;
    1511             :         const u8 *salt;
    1512             :         u8 *str;
    1513             :         const u8 *addr[3];
    1514             :         size_t len[3];
    1515             :         u8 hash[16];
    1516             :         u8 *pos;
    1517          11 :         size_t i, j = 0;
    1518             :         struct radius_attr_hdr *attr;
    1519             :         const u8 *data;
    1520             :         size_t dlen;
    1521          11 :         const u8 *fdata = NULL; /* points to found item */
    1522          11 :         size_t fdlen = -1;
    1523          11 :         char *ret = NULL;
    1524             : 
    1525             :         /* find n-th valid Tunnel-Password attribute */
    1526          26 :         for (i = 0; i < msg->attr_used; i++) {
    1527          17 :                 attr = radius_get_attr_hdr(msg, i);
    1528          34 :                 if (attr == NULL ||
    1529          17 :                     attr->type != RADIUS_ATTR_TUNNEL_PASSWORD) {
    1530          13 :                         continue;
    1531             :                 }
    1532           4 :                 if (attr->length <= 5)
    1533           0 :                         continue;
    1534           4 :                 data = (const u8 *) (attr + 1);
    1535           4 :                 dlen = attr->length - sizeof(*attr);
    1536           4 :                 if (dlen <= 3 || dlen % 16 != 3)
    1537           0 :                         continue;
    1538           4 :                 j++;
    1539           4 :                 if (j <= n)
    1540           2 :                         continue;
    1541             : 
    1542           2 :                 fdata = data;
    1543           2 :                 fdlen = dlen;
    1544           2 :                 break;
    1545             :         }
    1546          11 :         if (fdata == NULL)
    1547           9 :                 goto out;
    1548             : 
    1549             :         /* alloc writable memory for decryption */
    1550           2 :         buf = os_malloc(fdlen);
    1551           2 :         if (buf == NULL)
    1552           0 :                 goto out;
    1553           2 :         os_memcpy(buf, fdata, fdlen);
    1554           2 :         buflen = fdlen;
    1555             : 
    1556             :         /* init pointers */
    1557           2 :         salt = buf + 1;
    1558           2 :         str = buf + 3;
    1559             : 
    1560             :         /* decrypt blocks */
    1561           2 :         pos = buf + buflen - 16; /* last block */
    1562           5 :         while (pos >= str + 16) { /* all but the first block */
    1563           1 :                 addr[0] = secret;
    1564           1 :                 len[0] = secret_len;
    1565           1 :                 addr[1] = pos - 16;
    1566           1 :                 len[1] = 16;
    1567           1 :                 md5_vector(2, addr, len, hash);
    1568             : 
    1569          17 :                 for (i = 0; i < 16; i++)
    1570          16 :                         pos[i] ^= hash[i];
    1571             : 
    1572           1 :                 pos -= 16;
    1573             :         }
    1574             : 
    1575             :         /* decrypt first block */
    1576           2 :         if (str != pos)
    1577           0 :                 goto out;
    1578           2 :         addr[0] = secret;
    1579           2 :         len[0] = secret_len;
    1580           2 :         addr[1] = sent_msg->hdr->authenticator;
    1581           2 :         len[1] = 16;
    1582           2 :         addr[2] = salt;
    1583           2 :         len[2] = 2;
    1584           2 :         md5_vector(3, addr, len, hash);
    1585             : 
    1586          34 :         for (i = 0; i < 16; i++)
    1587          32 :                 pos[i] ^= hash[i];
    1588             : 
    1589             :         /* derive plaintext length from first subfield */
    1590           2 :         *keylen = (unsigned char) str[0];
    1591           2 :         if ((u8 *) (str + *keylen) >= (u8 *) (buf + buflen)) {
    1592             :                 /* decryption error - invalid key length */
    1593           0 :                 goto out;
    1594             :         }
    1595           2 :         if (*keylen == 0) {
    1596             :                 /* empty password */
    1597           0 :                 goto out;
    1598             :         }
    1599             : 
    1600             :         /* copy passphrase into new buffer */
    1601           2 :         ret = os_malloc(*keylen);
    1602           2 :         if (ret)
    1603           2 :                 os_memcpy(ret, str + 1, *keylen);
    1604             : 
    1605             : out:
    1606             :         /* return new buffer */
    1607          11 :         os_free(buf);
    1608          11 :         return ret;
    1609             : }
    1610             : 
    1611             : 
    1612        2331 : void radius_free_class(struct radius_class_data *c)
    1613             : {
    1614             :         size_t i;
    1615        2331 :         if (c == NULL)
    1616        2331 :                 return;
    1617        2343 :         for (i = 0; i < c->count; i++)
    1618          12 :                 os_free(c->attr[i].data);
    1619        2331 :         os_free(c->attr);
    1620        2331 :         c->attr = NULL;
    1621        2331 :         c->count = 0;
    1622             : }
    1623             : 
    1624             : 
    1625         706 : int radius_copy_class(struct radius_class_data *dst,
    1626             :                       const struct radius_class_data *src)
    1627             : {
    1628             :         size_t i;
    1629             : 
    1630         706 :         if (src->attr == NULL)
    1631         699 :                 return 0;
    1632             : 
    1633           7 :         dst->attr = os_calloc(src->count, sizeof(struct radius_attr_data));
    1634           7 :         if (dst->attr == NULL)
    1635           0 :                 return -1;
    1636             : 
    1637           7 :         dst->count = 0;
    1638             : 
    1639          14 :         for (i = 0; i < src->count; i++) {
    1640           7 :                 dst->attr[i].data = os_malloc(src->attr[i].len);
    1641           7 :                 if (dst->attr[i].data == NULL)
    1642           0 :                         break;
    1643           7 :                 dst->count++;
    1644           7 :                 os_memcpy(dst->attr[i].data, src->attr[i].data,
    1645             :                           src->attr[i].len);
    1646           7 :                 dst->attr[i].len = src->attr[i].len;
    1647             :         }
    1648             : 
    1649           7 :         return 0;
    1650             : }
    1651             : 
    1652             : 
    1653          24 : u8 radius_msg_find_unlisted_attr(struct radius_msg *msg, u8 *attrs)
    1654             : {
    1655             :         size_t i, j;
    1656             :         struct radius_attr_hdr *attr;
    1657             : 
    1658          93 :         for (i = 0; i < msg->attr_used; i++) {
    1659          70 :                 attr = radius_get_attr_hdr(msg, i);
    1660             : 
    1661         338 :                 for (j = 0; attrs[j]; j++) {
    1662         337 :                         if (attr->type == attrs[j])
    1663          69 :                                 break;
    1664             :                 }
    1665             : 
    1666          70 :                 if (attrs[j] == 0)
    1667           1 :                         return attr->type; /* unlisted attr */
    1668             :         }
    1669             : 
    1670          23 :         return 0;
    1671             : }

Generated by: LCOV version 1.10