A simple library to support serving https.
Dependents: oldheating gps motorhome heating
tls/tls-response.c@17:93feb2a51d58, 2019-10-10 (annotated)
- Committer:
- andrewboyson
- Date:
- Thu Oct 10 07:38:13 2019 +0000
- Revision:
- 17:93feb2a51d58
- Parent:
- 16:7eeb5f6626ad
- Child:
- 18:e3cf22ba2a06
Defined a lot of lengths eg 20 -> SHA1_HASH_LENGTH
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
andrewboyson | 10:e269fd7b9500 | 1 | #include "tls-defs.h" |
andrewboyson | 10:e269fd7b9500 | 2 | #include "tls-connection.h" |
andrewboyson | 10:e269fd7b9500 | 3 | #include "tls-session.h" |
andrewboyson | 10:e269fd7b9500 | 4 | #include "tls-log.h" |
andrewboyson | 10:e269fd7b9500 | 5 | #include "tls-prf.h" |
andrewboyson | 10:e269fd7b9500 | 6 | #include "ser-cer.h" |
andrewboyson | 10:e269fd7b9500 | 7 | #include "pri-key.h" |
andrewboyson | 10:e269fd7b9500 | 8 | #include "log.h" |
andrewboyson | 10:e269fd7b9500 | 9 | #include "aes128.h" |
andrewboyson | 10:e269fd7b9500 | 10 | #include "random.h" |
andrewboyson | 10:e269fd7b9500 | 11 | #include "tls-mac.h" |
andrewboyson | 10:e269fd7b9500 | 12 | #include "http.h" |
andrewboyson | 10:e269fd7b9500 | 13 | |
andrewboyson | 10:e269fd7b9500 | 14 | void backfillSize(uint8_t* pCurrent, uint8_t* pStart) |
andrewboyson | 10:e269fd7b9500 | 15 | { |
andrewboyson | 10:e269fd7b9500 | 16 | int size = pCurrent - pStart - 2; |
andrewboyson | 10:e269fd7b9500 | 17 | *(pStart + 0) = size >> 8; |
andrewboyson | 10:e269fd7b9500 | 18 | *(pStart + 1) = size & 0xFF; |
andrewboyson | 10:e269fd7b9500 | 19 | } |
andrewboyson | 14:03a0b8fd6ddc | 20 | void addSize(uint8_t** pp, int size) |
andrewboyson | 14:03a0b8fd6ddc | 21 | { |
andrewboyson | 14:03a0b8fd6ddc | 22 | uint8_t* p = *pp; |
andrewboyson | 14:03a0b8fd6ddc | 23 | *p++ = size >> 8; |
andrewboyson | 14:03a0b8fd6ddc | 24 | *p++ = size & 0xFF; |
andrewboyson | 14:03a0b8fd6ddc | 25 | *pp = p; |
andrewboyson | 14:03a0b8fd6ddc | 26 | } |
andrewboyson | 15:4ddb73b5fea1 | 27 | |
andrewboyson | 15:4ddb73b5fea1 | 28 | static uint8_t* encryptIvPointer; |
andrewboyson | 15:4ddb73b5fea1 | 29 | static uint8_t* encryptPayloadPointer; |
andrewboyson | 15:4ddb73b5fea1 | 30 | static int encryptPayloadSize; |
andrewboyson | 15:4ddb73b5fea1 | 31 | static void encryptAddIv(uint8_t** pp) |
andrewboyson | 15:4ddb73b5fea1 | 32 | { |
andrewboyson | 15:4ddb73b5fea1 | 33 | uint8_t* p = *pp; |
andrewboyson | 15:4ddb73b5fea1 | 34 | |
andrewboyson | 15:4ddb73b5fea1 | 35 | //Add the IV |
andrewboyson | 15:4ddb73b5fea1 | 36 | encryptIvPointer = p; |
andrewboyson | 17:93feb2a51d58 | 37 | for (int i = 0; i < TLS_LENGTH_CIPHER_BLOCK; i++) *p++ = RandomGetByte(); |
andrewboyson | 15:4ddb73b5fea1 | 38 | |
andrewboyson | 16:7eeb5f6626ad | 39 | encryptPayloadPointer = p; |
andrewboyson | 16:7eeb5f6626ad | 40 | |
andrewboyson | 15:4ddb73b5fea1 | 41 | *pp = p; |
andrewboyson | 15:4ddb73b5fea1 | 42 | } |
andrewboyson | 15:4ddb73b5fea1 | 43 | static void encryptAddMac(uint8_t** pp, struct TlsConnection* pConnection, uint8_t contentType) |
andrewboyson | 15:4ddb73b5fea1 | 44 | { |
andrewboyson | 15:4ddb73b5fea1 | 45 | uint8_t* p = *pp; |
andrewboyson | 15:4ddb73b5fea1 | 46 | |
andrewboyson | 16:7eeb5f6626ad | 47 | encryptPayloadSize = p - encryptPayloadPointer; |
andrewboyson | 16:7eeb5f6626ad | 48 | |
andrewboyson | 15:4ddb73b5fea1 | 49 | //Add the MAC |
andrewboyson | 17:93feb2a51d58 | 50 | TlsMacSha1(TLS_LENGTH_MAC_KEY, |
andrewboyson | 15:4ddb73b5fea1 | 51 | pConnection->serverMacKey, |
andrewboyson | 15:4ddb73b5fea1 | 52 | pConnection->serverSequence, |
andrewboyson | 15:4ddb73b5fea1 | 53 | contentType, |
andrewboyson | 15:4ddb73b5fea1 | 54 | 0x03, |
andrewboyson | 15:4ddb73b5fea1 | 55 | 0x03, |
andrewboyson | 15:4ddb73b5fea1 | 56 | encryptPayloadSize, |
andrewboyson | 15:4ddb73b5fea1 | 57 | encryptPayloadPointer, |
andrewboyson | 15:4ddb73b5fea1 | 58 | p); |
andrewboyson | 17:93feb2a51d58 | 59 | p += TLS_LENGTH_MAC; |
andrewboyson | 15:4ddb73b5fea1 | 60 | |
andrewboyson | 15:4ddb73b5fea1 | 61 | *pp = p; |
andrewboyson | 15:4ddb73b5fea1 | 62 | } |
andrewboyson | 15:4ddb73b5fea1 | 63 | |
andrewboyson | 15:4ddb73b5fea1 | 64 | static void encryptAddPadding(uint8_t** pp) |
andrewboyson | 15:4ddb73b5fea1 | 65 | { |
andrewboyson | 15:4ddb73b5fea1 | 66 | uint8_t* p = *pp; |
andrewboyson | 15:4ddb73b5fea1 | 67 | |
andrewboyson | 17:93feb2a51d58 | 68 | int paddingSize = TLS_LENGTH_CIPHER_BLOCK - 1 - (encryptPayloadSize + TLS_LENGTH_MAC + 1 - 1) % TLS_LENGTH_CIPHER_BLOCK; |
andrewboyson | 15:4ddb73b5fea1 | 69 | LogF("- padding size %d\r\n", paddingSize); |
andrewboyson | 15:4ddb73b5fea1 | 70 | for (int i = 0; i < paddingSize; i++) *p++ = paddingSize; |
andrewboyson | 15:4ddb73b5fea1 | 71 | |
andrewboyson | 15:4ddb73b5fea1 | 72 | *p++ = paddingSize; |
andrewboyson | 15:4ddb73b5fea1 | 73 | |
andrewboyson | 15:4ddb73b5fea1 | 74 | *pp = p; |
andrewboyson | 15:4ddb73b5fea1 | 75 | } |
andrewboyson | 15:4ddb73b5fea1 | 76 | static void encryptPayload(uint8_t* p, struct TlsConnection* pConnection) |
andrewboyson | 15:4ddb73b5fea1 | 77 | { |
andrewboyson | 15:4ddb73b5fea1 | 78 | //Encrypt payload + mac + padding |
andrewboyson | 15:4ddb73b5fea1 | 79 | struct AES_ctx ctx; |
andrewboyson | 15:4ddb73b5fea1 | 80 | AES_init_ctx_iv(&ctx, pConnection->serverWriteKey, encryptIvPointer); |
andrewboyson | 15:4ddb73b5fea1 | 81 | AES_CBC_encrypt_buffer(&ctx, encryptPayloadPointer, p - encryptPayloadPointer);} |
andrewboyson | 15:4ddb73b5fea1 | 82 | |
andrewboyson | 15:4ddb73b5fea1 | 83 | |
andrewboyson | 14:03a0b8fd6ddc | 84 | static uint8_t* pHandshakeSize; |
andrewboyson | 14:03a0b8fd6ddc | 85 | static uint8_t* pHandshakePayload; |
andrewboyson | 14:03a0b8fd6ddc | 86 | static void addHandshakeStart(uint8_t** pp) |
andrewboyson | 10:e269fd7b9500 | 87 | { |
andrewboyson | 14:03a0b8fd6ddc | 88 | uint8_t* p = *pp; |
andrewboyson | 14:03a0b8fd6ddc | 89 | |
andrewboyson | 14:03a0b8fd6ddc | 90 | *p++ = TLS_CONTENT_TYPE_HANDSHAKE; |
andrewboyson | 14:03a0b8fd6ddc | 91 | *p++ = 0x03; *p++ = 0x03; |
andrewboyson | 14:03a0b8fd6ddc | 92 | pHandshakeSize = p; //Store the position to backfill the handshake size |
andrewboyson | 14:03a0b8fd6ddc | 93 | p += 2; //Leave room to backfill the handshake size |
andrewboyson | 14:03a0b8fd6ddc | 94 | pHandshakePayload = p; //Record the position of the handshake payload to later calculate the hash |
andrewboyson | 10:e269fd7b9500 | 95 | |
andrewboyson | 14:03a0b8fd6ddc | 96 | *pp = p; |
andrewboyson | 14:03a0b8fd6ddc | 97 | } |
andrewboyson | 14:03a0b8fd6ddc | 98 | static void addHandshakeEnd(uint8_t* p, struct TlsConnection* pConnection) |
andrewboyson | 14:03a0b8fd6ddc | 99 | { |
andrewboyson | 14:03a0b8fd6ddc | 100 | backfillSize(p, pHandshakeSize); |
andrewboyson | 14:03a0b8fd6ddc | 101 | Sha256Add(&pConnection->handshakeSha, pHandshakePayload, p - pHandshakePayload); //Add the handshake hash |
andrewboyson | 14:03a0b8fd6ddc | 102 | pConnection->serverSequence++; |
andrewboyson | 14:03a0b8fd6ddc | 103 | } |
andrewboyson | 14:03a0b8fd6ddc | 104 | static void addHandshakeServerHello(uint8_t** pp, struct TlsConnection* pConnection) |
andrewboyson | 14:03a0b8fd6ddc | 105 | { |
andrewboyson | 14:03a0b8fd6ddc | 106 | Log(" sending handshake server hello\r\n"); |
andrewboyson | 14:03a0b8fd6ddc | 107 | uint8_t* p = *pp; |
andrewboyson | 14:03a0b8fd6ddc | 108 | |
andrewboyson | 14:03a0b8fd6ddc | 109 | *p++ = TLS_HANDSHAKE_SERVER_HELLO; |
andrewboyson | 10:e269fd7b9500 | 110 | *p++ = 0x00; |
andrewboyson | 14:03a0b8fd6ddc | 111 | uint8_t* pSize = p; |
andrewboyson | 14:03a0b8fd6ddc | 112 | p += 2; |
andrewboyson | 14:03a0b8fd6ddc | 113 | *p++ = 0x03; *p++ = 0x03; |
andrewboyson | 17:93feb2a51d58 | 114 | for (int i = 0; i < TLS_LENGTH_RANDOM; i++) |
andrewboyson | 10:e269fd7b9500 | 115 | { |
andrewboyson | 10:e269fd7b9500 | 116 | uint8_t r = RandomGetByte(); |
andrewboyson | 10:e269fd7b9500 | 117 | pConnection->serverRandom[i] = r; |
andrewboyson | 14:03a0b8fd6ddc | 118 | *p++ = r; //32 bit random number |
andrewboyson | 10:e269fd7b9500 | 119 | } |
andrewboyson | 14:03a0b8fd6ddc | 120 | *p++ = 0x04; //SessionId length 4 |
andrewboyson | 14:03a0b8fd6ddc | 121 | *p++ = pConnection->sessionId >> 24; //Session id |
andrewboyson | 14:03a0b8fd6ddc | 122 | *p++ = pConnection->sessionId >> 16; //Session id |
andrewboyson | 14:03a0b8fd6ddc | 123 | *p++ = pConnection->sessionId >> 8; //Session id |
andrewboyson | 14:03a0b8fd6ddc | 124 | *p++ = pConnection->sessionId >> 0; //Session id |
andrewboyson | 14:03a0b8fd6ddc | 125 | *p++ = 0x00; *p++ = 0x2f; //Cipher Suite: TLS_RSA_WITH_AES_128_CBC_SHA (0x002f) |
andrewboyson | 14:03a0b8fd6ddc | 126 | *p++ = 0x00; //Compression method none |
andrewboyson | 14:03a0b8fd6ddc | 127 | *p++ = 0x00; *p++ = 0x05; //Extensions length (2 bytes) 5 bytes |
andrewboyson | 14:03a0b8fd6ddc | 128 | *p++ = 0xff; *p++ = 0x01; //Extension Renegotiation Info |
andrewboyson | 14:03a0b8fd6ddc | 129 | *p++ = 0x00; *p++ = 0x01; //1 bytes of "Renegotiation Info" extension data follows |
andrewboyson | 14:03a0b8fd6ddc | 130 | *p++ = 0x00; //length is zero, because this is a new connection |
andrewboyson | 14:03a0b8fd6ddc | 131 | backfillSize(p, pSize); |
andrewboyson | 10:e269fd7b9500 | 132 | |
andrewboyson | 14:03a0b8fd6ddc | 133 | *pp = p; |
andrewboyson | 14:03a0b8fd6ddc | 134 | } |
andrewboyson | 14:03a0b8fd6ddc | 135 | static void addHandshakeCertificate(uint8_t** pp) |
andrewboyson | 14:03a0b8fd6ddc | 136 | { |
andrewboyson | 14:03a0b8fd6ddc | 137 | uint8_t* p = *pp; |
andrewboyson | 14:03a0b8fd6ddc | 138 | |
andrewboyson | 14:03a0b8fd6ddc | 139 | *p++ = TLS_HANDSHAKE_CERTIFICATE; *p++ = 0x00; |
andrewboyson | 13:0a80b49a5e78 | 140 | addSize(&p, SerCerSize + 6); *p++ = 0x00; //Size of this handshake |
andrewboyson | 13:0a80b49a5e78 | 141 | addSize(&p, SerCerSize + 3); *p++ = 0x00; //Size of all certificates |
andrewboyson | 13:0a80b49a5e78 | 142 | addSize(&p, SerCerSize ); //Size of first certificate |
andrewboyson | 10:e269fd7b9500 | 143 | for (int i = 0; i < SerCerSize; i++) *p++ = SerCerData[i]; //Certificate |
andrewboyson | 10:e269fd7b9500 | 144 | |
andrewboyson | 14:03a0b8fd6ddc | 145 | *pp = p; |
andrewboyson | 14:03a0b8fd6ddc | 146 | } |
andrewboyson | 14:03a0b8fd6ddc | 147 | static void addHandshakeServerHelloDone(uint8_t** pp) |
andrewboyson | 14:03a0b8fd6ddc | 148 | { |
andrewboyson | 14:03a0b8fd6ddc | 149 | LogTime(" sending handshake server hello done\r\n"); |
andrewboyson | 14:03a0b8fd6ddc | 150 | uint8_t* p = *pp; |
andrewboyson | 10:e269fd7b9500 | 151 | |
andrewboyson | 14:03a0b8fd6ddc | 152 | *p++ = TLS_HANDSHAKE_SERVER_HELLO_DONE; *p++ = 0x00; |
andrewboyson | 14:03a0b8fd6ddc | 153 | addSize(&p, 0); |
andrewboyson | 14:03a0b8fd6ddc | 154 | |
andrewboyson | 14:03a0b8fd6ddc | 155 | *pp = p; |
andrewboyson | 10:e269fd7b9500 | 156 | } |
andrewboyson | 14:03a0b8fd6ddc | 157 | static void addHandshakeFinished(uint8_t** pp, struct TlsConnection* pConnection, struct TlsSession* pSession) |
andrewboyson | 10:e269fd7b9500 | 158 | { |
andrewboyson | 14:03a0b8fd6ddc | 159 | LogTime(" sending handshake finished\r\n"); |
andrewboyson | 14:03a0b8fd6ddc | 160 | uint8_t* p = *pp; |
andrewboyson | 10:e269fd7b9500 | 161 | |
andrewboyson | 15:4ddb73b5fea1 | 162 | encryptAddIv(&p); |
andrewboyson | 15:4ddb73b5fea1 | 163 | |
andrewboyson | 16:7eeb5f6626ad | 164 | //Make the 'finished' handshake which is part of the payload to be encrypted |
andrewboyson | 15:4ddb73b5fea1 | 165 | *p++ = TLS_HANDSHAKE_FINISHED; |
andrewboyson | 15:4ddb73b5fea1 | 166 | *p++ = 0x00; |
andrewboyson | 15:4ddb73b5fea1 | 167 | *p++ = 0x00; |
andrewboyson | 17:93feb2a51d58 | 168 | *p++ = TLS_LENGTH_VERIFY; //Length 12 |
andrewboyson | 15:4ddb73b5fea1 | 169 | |
andrewboyson | 10:e269fd7b9500 | 170 | //Hash over all handshake payloads exchanged so far |
andrewboyson | 17:93feb2a51d58 | 171 | uint8_t hash[SHA256_HASH_SIZE]; |
andrewboyson | 10:e269fd7b9500 | 172 | Sha256Finish(&pConnection->handshakeSha, hash); |
andrewboyson | 10:e269fd7b9500 | 173 | |
andrewboyson | 10:e269fd7b9500 | 174 | //Make verify data |
andrewboyson | 15:4ddb73b5fea1 | 175 | TlsPrfServerFinished(pSession->masterSecret, hash, p); //Hash over all handshakes |
andrewboyson | 17:93feb2a51d58 | 176 | p += TLS_LENGTH_VERIFY; |
andrewboyson | 10:e269fd7b9500 | 177 | |
andrewboyson | 15:4ddb73b5fea1 | 178 | encryptAddMac (&p, pConnection, TLS_CONTENT_TYPE_HANDSHAKE); |
andrewboyson | 15:4ddb73b5fea1 | 179 | encryptAddPadding(&p); |
andrewboyson | 15:4ddb73b5fea1 | 180 | encryptPayload ( p, pConnection); |
andrewboyson | 14:03a0b8fd6ddc | 181 | |
andrewboyson | 14:03a0b8fd6ddc | 182 | *pp = p; |
andrewboyson | 14:03a0b8fd6ddc | 183 | } |
andrewboyson | 14:03a0b8fd6ddc | 184 | static void addChangeCipher(uint8_t** pp, struct TlsConnection* pConnection) |
andrewboyson | 14:03a0b8fd6ddc | 185 | { |
andrewboyson | 14:03a0b8fd6ddc | 186 | LogTime(" sending change cipher\r\n"); |
andrewboyson | 14:03a0b8fd6ddc | 187 | uint8_t* p = *pp; |
andrewboyson | 14:03a0b8fd6ddc | 188 | |
andrewboyson | 14:03a0b8fd6ddc | 189 | *p++ = TLS_CONTENT_TYPE_CHANGE_CIPHER; //Content is change cipher |
andrewboyson | 14:03a0b8fd6ddc | 190 | *p++ = 0x03; *p++ = 0x03; //Legacy TLS version |
andrewboyson | 14:03a0b8fd6ddc | 191 | *p++ = 0x00; *p++ = 0x01; //Change cipher Length (2 bytes) |
andrewboyson | 14:03a0b8fd6ddc | 192 | *p++ = 0x01; //Change cipher message 1 |
andrewboyson | 10:e269fd7b9500 | 193 | |
andrewboyson | 14:03a0b8fd6ddc | 194 | //Record that all outgoing messages are now encrypted |
andrewboyson | 14:03a0b8fd6ddc | 195 | pConnection->serverEncrypted = true; |
andrewboyson | 14:03a0b8fd6ddc | 196 | pConnection->serverSequence = 0; |
andrewboyson | 14:03a0b8fd6ddc | 197 | |
andrewboyson | 14:03a0b8fd6ddc | 198 | *pp = p; |
andrewboyson | 14:03a0b8fd6ddc | 199 | } |
andrewboyson | 14:03a0b8fd6ddc | 200 | static void addAlert(uint8_t** pp, struct TlsConnection* pConnection, uint8_t level, uint8_t description) |
andrewboyson | 14:03a0b8fd6ddc | 201 | { |
andrewboyson | 14:03a0b8fd6ddc | 202 | LogTime(" sending alert\r\n"); |
andrewboyson | 14:03a0b8fd6ddc | 203 | Log (" - "); TlsLogAlertLevel(level); Log(": "); TlsLogAlertDescription(description); Log("\r\n"); |
andrewboyson | 14:03a0b8fd6ddc | 204 | |
andrewboyson | 14:03a0b8fd6ddc | 205 | uint8_t* p = *pp; |
andrewboyson | 14:03a0b8fd6ddc | 206 | |
andrewboyson | 14:03a0b8fd6ddc | 207 | *p++ = TLS_CONTENT_TYPE_ALERT; |
andrewboyson | 14:03a0b8fd6ddc | 208 | *p++ = 0x03; *p++ = 0x03; |
andrewboyson | 14:03a0b8fd6ddc | 209 | addSize(&p, 2); |
andrewboyson | 14:03a0b8fd6ddc | 210 | *p++ = level; |
andrewboyson | 14:03a0b8fd6ddc | 211 | *p++ = description; |
andrewboyson | 14:03a0b8fd6ddc | 212 | |
andrewboyson | 10:e269fd7b9500 | 213 | pConnection->serverSequence++; |
andrewboyson | 14:03a0b8fd6ddc | 214 | |
andrewboyson | 14:03a0b8fd6ddc | 215 | *pp = p; |
andrewboyson | 14:03a0b8fd6ddc | 216 | } |
andrewboyson | 14:03a0b8fd6ddc | 217 | static void sendServerHelloNew(struct TlsConnection* pConnection, struct TlsSession* pSession, int* pWindowSize, uint8_t* pWindow, uint32_t positionOfWindowInStream) |
andrewboyson | 14:03a0b8fd6ddc | 218 | { |
andrewboyson | 14:03a0b8fd6ddc | 219 | uint8_t* p = pWindow; |
andrewboyson | 14:03a0b8fd6ddc | 220 | |
andrewboyson | 14:03a0b8fd6ddc | 221 | addHandshakeStart (&p); |
andrewboyson | 14:03a0b8fd6ddc | 222 | addHandshakeServerHello (&p, pConnection); |
andrewboyson | 14:03a0b8fd6ddc | 223 | addHandshakeCertificate (&p); |
andrewboyson | 14:03a0b8fd6ddc | 224 | addHandshakeServerHelloDone(&p); |
andrewboyson | 14:03a0b8fd6ddc | 225 | addHandshakeEnd ( p, pConnection); |
andrewboyson | 14:03a0b8fd6ddc | 226 | |
andrewboyson | 10:e269fd7b9500 | 227 | *pWindowSize = p - pWindow; |
andrewboyson | 10:e269fd7b9500 | 228 | pConnection->serverPositionInStreamOffset = positionOfWindowInStream + *pWindowSize; |
andrewboyson | 10:e269fd7b9500 | 229 | } |
andrewboyson | 14:03a0b8fd6ddc | 230 | static void sendServerHelloResume(struct TlsConnection* pConnection, struct TlsSession* pSession, int* pWindowSize, uint8_t* pWindow, uint32_t positionOfWindowInStream) |
andrewboyson | 10:e269fd7b9500 | 231 | { |
andrewboyson | 10:e269fd7b9500 | 232 | uint8_t* p = pWindow; |
andrewboyson | 14:03a0b8fd6ddc | 233 | |
andrewboyson | 14:03a0b8fd6ddc | 234 | addHandshakeStart (&p); |
andrewboyson | 14:03a0b8fd6ddc | 235 | addHandshakeServerHello(&p, pConnection); |
andrewboyson | 14:03a0b8fd6ddc | 236 | addHandshakeEnd ( p, pConnection); |
andrewboyson | 10:e269fd7b9500 | 237 | |
andrewboyson | 14:03a0b8fd6ddc | 238 | TlsPrfKeys (pSession->masterSecret, pConnection->clientRandom, pConnection->serverRandom, pConnection->clientMacKey, |
andrewboyson | 14:03a0b8fd6ddc | 239 | pConnection->serverMacKey, |
andrewboyson | 14:03a0b8fd6ddc | 240 | pConnection->clientWriteKey, |
andrewboyson | 14:03a0b8fd6ddc | 241 | pConnection->serverWriteKey); |
andrewboyson | 14:03a0b8fd6ddc | 242 | |
andrewboyson | 14:03a0b8fd6ddc | 243 | addChangeCipher (&p, pConnection); |
andrewboyson | 14:03a0b8fd6ddc | 244 | |
andrewboyson | 14:03a0b8fd6ddc | 245 | addHandshakeStart (&p); |
andrewboyson | 14:03a0b8fd6ddc | 246 | addHandshakeFinished (&p, pConnection, pSession); |
andrewboyson | 14:03a0b8fd6ddc | 247 | addHandshakeEnd ( p, pConnection); |
andrewboyson | 10:e269fd7b9500 | 248 | |
andrewboyson | 10:e269fd7b9500 | 249 | *pWindowSize = p - pWindow; |
andrewboyson | 14:03a0b8fd6ddc | 250 | pConnection->serverPositionInStreamOffset = positionOfWindowInStream + *pWindowSize; |
andrewboyson | 14:03a0b8fd6ddc | 251 | } |
andrewboyson | 14:03a0b8fd6ddc | 252 | static void sendServerChange(struct TlsConnection* pConnection, struct TlsSession* pSession, int* pWindowSize, uint8_t* pWindow, uint32_t positionOfWindowInStream) |
andrewboyson | 14:03a0b8fd6ddc | 253 | { |
andrewboyson | 14:03a0b8fd6ddc | 254 | uint8_t* p = pWindow; |
andrewboyson | 14:03a0b8fd6ddc | 255 | |
andrewboyson | 14:03a0b8fd6ddc | 256 | addChangeCipher(&p, pConnection); |
andrewboyson | 14:03a0b8fd6ddc | 257 | |
andrewboyson | 14:03a0b8fd6ddc | 258 | addHandshakeStart (&p); |
andrewboyson | 14:03a0b8fd6ddc | 259 | addHandshakeFinished(&p, pConnection, pSession); |
andrewboyson | 14:03a0b8fd6ddc | 260 | addHandshakeEnd ( p, pConnection); |
andrewboyson | 14:03a0b8fd6ddc | 261 | |
andrewboyson | 14:03a0b8fd6ddc | 262 | *pWindowSize = p - pWindow; |
andrewboyson | 14:03a0b8fd6ddc | 263 | pConnection->serverPositionInStreamOffset = positionOfWindowInStream + *pWindowSize; |
andrewboyson | 14:03a0b8fd6ddc | 264 | } |
andrewboyson | 14:03a0b8fd6ddc | 265 | static void sendFatal(uint8_t description, struct TlsConnection* pConnection, int* pWindowSize, uint8_t* pWindow, uint32_t positionOfWindowInStream) |
andrewboyson | 14:03a0b8fd6ddc | 266 | { |
andrewboyson | 14:03a0b8fd6ddc | 267 | uint8_t* p = pWindow; |
andrewboyson | 14:03a0b8fd6ddc | 268 | |
andrewboyson | 14:03a0b8fd6ddc | 269 | addAlert(&p, pConnection, TLS_ALERT_FATAL, description); |
andrewboyson | 14:03a0b8fd6ddc | 270 | |
andrewboyson | 14:03a0b8fd6ddc | 271 | *pWindowSize = p - pWindow; |
andrewboyson | 14:03a0b8fd6ddc | 272 | pConnection->serverPositionInStreamOffset = positionOfWindowInStream + *pWindowSize; |
andrewboyson | 10:e269fd7b9500 | 273 | } |
andrewboyson | 10:e269fd7b9500 | 274 | static bool sendContent(struct TlsConnection* pConnection, int* pWindowSize, uint8_t* pWindow, uint32_t positionOfWindowInStream) |
andrewboyson | 10:e269fd7b9500 | 275 | { |
andrewboyson | 10:e269fd7b9500 | 276 | /* |
andrewboyson | 10:e269fd7b9500 | 277 | content: |
andrewboyson | 10:e269fd7b9500 | 278 | contentType * 1 |
andrewboyson | 10:e269fd7b9500 | 279 | version * 2 |
andrewboyson | 10:e269fd7b9500 | 280 | length * 2 |
andrewboyson | 10:e269fd7b9500 | 281 | iv * AES_BLOCKLEN (16) |
andrewboyson | 10:e269fd7b9500 | 282 | message: |
andrewboyson | 10:e269fd7b9500 | 283 | payload * payloadLength |
andrewboyson | 10:e269fd7b9500 | 284 | mac * SHA1_HASH_SIZE (20) |
andrewboyson | 10:e269fd7b9500 | 285 | padding * 0 to AES_BLOCKLEN - 1 (0 to 15) |
andrewboyson | 10:e269fd7b9500 | 286 | paddingLength * 1 |
andrewboyson | 10:e269fd7b9500 | 287 | */ |
andrewboyson | 10:e269fd7b9500 | 288 | #define CONTENT_MAX_OVERHEAD (5 + AES_BLOCKLEN + SHA1_HASH_SIZE + AES_BLOCKLEN - 1 + 1) |
andrewboyson | 10:e269fd7b9500 | 289 | |
andrewboyson | 10:e269fd7b9500 | 290 | //Start |
andrewboyson | 10:e269fd7b9500 | 291 | LogTime(" adding application content\r\n"); |
andrewboyson | 10:e269fd7b9500 | 292 | LogF("- available window size %d\r\n", *pWindowSize); |
andrewboyson | 10:e269fd7b9500 | 293 | LogF("- position of window in stream %d\r\n", positionOfWindowInStream); |
andrewboyson | 10:e269fd7b9500 | 294 | uint8_t* p = pWindow; |
andrewboyson | 13:0a80b49a5e78 | 295 | *p++ = TLS_CONTENT_TYPE_APPLICATION; |
andrewboyson | 10:e269fd7b9500 | 296 | *p++ = 0x03; *p++ = 0x03; |
andrewboyson | 10:e269fd7b9500 | 297 | |
andrewboyson | 10:e269fd7b9500 | 298 | //Prepare a place to backfill the size |
andrewboyson | 10:e269fd7b9500 | 299 | uint8_t* pBackfillSize = p; |
andrewboyson | 10:e269fd7b9500 | 300 | *p++ = 0; *p++ = 0; |
andrewboyson | 10:e269fd7b9500 | 301 | |
andrewboyson | 15:4ddb73b5fea1 | 302 | encryptAddIv(&p); |
andrewboyson | 10:e269fd7b9500 | 303 | |
andrewboyson | 10:e269fd7b9500 | 304 | //Add the plain payload |
andrewboyson | 16:7eeb5f6626ad | 305 | int payloadSize = *pWindowSize - CONTENT_MAX_OVERHEAD; |
andrewboyson | 16:7eeb5f6626ad | 306 | LogF("- available payload size %d\r\n", payloadSize); |
andrewboyson | 10:e269fd7b9500 | 307 | uint32_t positionOfPayloadInStream = positionOfWindowInStream - pConnection->serverPositionInStreamOffset; |
andrewboyson | 10:e269fd7b9500 | 308 | LogF("- position of payload in stream %d\r\n", positionOfPayloadInStream); |
andrewboyson | 16:7eeb5f6626ad | 309 | bool finished = HttpAdd(pConnection->id, &payloadSize, (char*)p, positionOfPayloadInStream); //Return whatever HTTP would be |
andrewboyson | 16:7eeb5f6626ad | 310 | LogF("- resulting payload size %d\r\n", payloadSize); |
andrewboyson | 16:7eeb5f6626ad | 311 | p += payloadSize; |
andrewboyson | 10:e269fd7b9500 | 312 | |
andrewboyson | 15:4ddb73b5fea1 | 313 | encryptAddMac (&p, pConnection, TLS_CONTENT_TYPE_APPLICATION); |
andrewboyson | 15:4ddb73b5fea1 | 314 | encryptAddPadding(&p); |
andrewboyson | 16:7eeb5f6626ad | 315 | encryptPayload ( p, pConnection); |
andrewboyson | 10:e269fd7b9500 | 316 | |
andrewboyson | 10:e269fd7b9500 | 317 | //Backfill the size |
andrewboyson | 10:e269fd7b9500 | 318 | backfillSize(p, pBackfillSize); |
andrewboyson | 10:e269fd7b9500 | 319 | |
andrewboyson | 16:7eeb5f6626ad | 320 | //Finalise |
andrewboyson | 16:7eeb5f6626ad | 321 | pConnection->serverSequence++; |
andrewboyson | 10:e269fd7b9500 | 322 | *pWindowSize = p - pWindow; |
andrewboyson | 10:e269fd7b9500 | 323 | LogF("- resulting window size %d\r\n", *pWindowSize); |
andrewboyson | 16:7eeb5f6626ad | 324 | pConnection->serverPositionInStreamOffset += *pWindowSize - payloadSize; |
andrewboyson | 10:e269fd7b9500 | 325 | |
andrewboyson | 10:e269fd7b9500 | 326 | return finished; |
andrewboyson | 10:e269fd7b9500 | 327 | } |
andrewboyson | 10:e269fd7b9500 | 328 | bool TlsResponse(int connectionId, bool clientFinished, int* pWindowSize, uint8_t* pWindow, uint32_t positionOfWindowInStream) |
andrewboyson | 10:e269fd7b9500 | 329 | { |
andrewboyson | 10:e269fd7b9500 | 330 | struct TlsConnection* pConnection = TlsConnectionOrNull(connectionId); |
andrewboyson | 10:e269fd7b9500 | 331 | if (!pConnection) |
andrewboyson | 10:e269fd7b9500 | 332 | { |
andrewboyson | 10:e269fd7b9500 | 333 | *pWindowSize = 0; |
andrewboyson | 10:e269fd7b9500 | 334 | return false; |
andrewboyson | 10:e269fd7b9500 | 335 | } |
andrewboyson | 10:e269fd7b9500 | 336 | |
andrewboyson | 10:e269fd7b9500 | 337 | if (!pConnection->sessionId) |
andrewboyson | 10:e269fd7b9500 | 338 | { |
andrewboyson | 10:e269fd7b9500 | 339 | *pWindowSize = 0; |
andrewboyson | 10:e269fd7b9500 | 340 | return false; |
andrewboyson | 10:e269fd7b9500 | 341 | } |
andrewboyson | 10:e269fd7b9500 | 342 | |
andrewboyson | 10:e269fd7b9500 | 343 | struct TlsSession* pSession = TlsSessionOrNull(pConnection->sessionId); |
andrewboyson | 10:e269fd7b9500 | 344 | if (!pSession) |
andrewboyson | 10:e269fd7b9500 | 345 | { |
andrewboyson | 10:e269fd7b9500 | 346 | LogTimeF("TlsPoll - invalid session %u\r\n", pConnection->sessionId); |
andrewboyson | 10:e269fd7b9500 | 347 | *pWindowSize = 0; |
andrewboyson | 10:e269fd7b9500 | 348 | return false; |
andrewboyson | 10:e269fd7b9500 | 349 | } |
andrewboyson | 10:e269fd7b9500 | 350 | |
andrewboyson | 10:e269fd7b9500 | 351 | switch (pConnection->toDo) |
andrewboyson | 10:e269fd7b9500 | 352 | { |
andrewboyson | 10:e269fd7b9500 | 353 | case DO_WAIT_CLIENT_HELLO: |
andrewboyson | 10:e269fd7b9500 | 354 | case DO_WAIT_CLIENT_CHANGE: |
andrewboyson | 10:e269fd7b9500 | 355 | case DO_WAIT_DECRYPT_MASTER_SECRET: |
andrewboyson | 10:e269fd7b9500 | 356 | *pWindowSize = 0; |
andrewboyson | 10:e269fd7b9500 | 357 | if (clientFinished) return true; //The client hasn't made a request and never will so finish |
andrewboyson | 10:e269fd7b9500 | 358 | else return false; //The client hasn't made a request yet but it could. |
andrewboyson | 10:e269fd7b9500 | 359 | |
andrewboyson | 14:03a0b8fd6ddc | 360 | case DO_SEND_SERVER_HELLO_NEW: |
andrewboyson | 14:03a0b8fd6ddc | 361 | sendServerHelloNew(pConnection, pSession, pWindowSize, pWindow, positionOfWindowInStream); |
andrewboyson | 14:03a0b8fd6ddc | 362 | pConnection->toDo = DO_WAIT_CLIENT_CHANGE; |
andrewboyson | 14:03a0b8fd6ddc | 363 | return false; //Not finished |
andrewboyson | 14:03a0b8fd6ddc | 364 | |
andrewboyson | 14:03a0b8fd6ddc | 365 | case DO_SEND_SERVER_HELLO_RESUME: |
andrewboyson | 14:03a0b8fd6ddc | 366 | sendServerHelloResume(pConnection, pSession, pWindowSize, pWindow, positionOfWindowInStream); |
andrewboyson | 10:e269fd7b9500 | 367 | pConnection->toDo = DO_WAIT_CLIENT_CHANGE; |
andrewboyson | 10:e269fd7b9500 | 368 | return false; //Not finished |
andrewboyson | 10:e269fd7b9500 | 369 | |
andrewboyson | 10:e269fd7b9500 | 370 | case DO_SEND_SERVER_CHANGE: |
andrewboyson | 10:e269fd7b9500 | 371 | sendServerChange(pConnection, pSession, pWindowSize, pWindow, positionOfWindowInStream); |
andrewboyson | 10:e269fd7b9500 | 372 | pConnection->toDo = DO_APPLICATION; |
andrewboyson | 10:e269fd7b9500 | 373 | return false; |
andrewboyson | 10:e269fd7b9500 | 374 | |
andrewboyson | 10:e269fd7b9500 | 375 | case DO_APPLICATION: |
andrewboyson | 10:e269fd7b9500 | 376 | { |
andrewboyson | 10:e269fd7b9500 | 377 | int status = HttpPoll(connectionId, clientFinished); |
andrewboyson | 10:e269fd7b9500 | 378 | bool finished; |
andrewboyson | 10:e269fd7b9500 | 379 | switch (status) |
andrewboyson | 10:e269fd7b9500 | 380 | { |
andrewboyson | 10:e269fd7b9500 | 381 | case HTTP_WAIT: finished = false; *pWindowSize = 0; break; |
andrewboyson | 10:e269fd7b9500 | 382 | case HTTP_FINISHED: finished = true; *pWindowSize = 0; break; |
andrewboyson | 10:e269fd7b9500 | 383 | case HTTP_HAVE_SOMETHING_TO_SEND: finished = sendContent(pConnection, pWindowSize, pWindow, positionOfWindowInStream); break; |
andrewboyson | 10:e269fd7b9500 | 384 | } |
andrewboyson | 10:e269fd7b9500 | 385 | if (finished) pConnection->toDo = DO_WAIT_CLIENT_HELLO; |
andrewboyson | 10:e269fd7b9500 | 386 | return finished; |
andrewboyson | 10:e269fd7b9500 | 387 | } |
andrewboyson | 10:e269fd7b9500 | 388 | case DO_SEND_ALERT_ILLEGAL_PARAMETER: |
andrewboyson | 14:03a0b8fd6ddc | 389 | sendFatal(TLS_ALERT_ILLEGAL_PARAMETER, pConnection, pWindowSize, pWindow, positionOfWindowInStream); |
andrewboyson | 10:e269fd7b9500 | 390 | pConnection->toDo = DO_WAIT_CLIENT_HELLO; |
andrewboyson | 10:e269fd7b9500 | 391 | return true; //Finished |
andrewboyson | 10:e269fd7b9500 | 392 | |
andrewboyson | 10:e269fd7b9500 | 393 | case DO_SEND_ALERT_INTERNAL_ERROR: |
andrewboyson | 14:03a0b8fd6ddc | 394 | sendFatal(TLS_ALERT_INTERNAL_ERROR, pConnection, pWindowSize, pWindow, positionOfWindowInStream); |
andrewboyson | 10:e269fd7b9500 | 395 | pConnection->toDo = DO_WAIT_CLIENT_HELLO; |
andrewboyson | 10:e269fd7b9500 | 396 | return true; //Finished |
andrewboyson | 10:e269fd7b9500 | 397 | |
andrewboyson | 10:e269fd7b9500 | 398 | default: |
andrewboyson | 10:e269fd7b9500 | 399 | LogTimeF("TlsPoll - unspecified TLS state %d\r\n", pConnection->toDo); |
andrewboyson | 14:03a0b8fd6ddc | 400 | sendFatal(TLS_ALERT_INTERNAL_ERROR, pConnection, pWindowSize, pWindow, positionOfWindowInStream); //Internal error |
andrewboyson | 10:e269fd7b9500 | 401 | pConnection->toDo = DO_WAIT_CLIENT_HELLO; |
andrewboyson | 10:e269fd7b9500 | 402 | return true; //Finished |
andrewboyson | 10:e269fd7b9500 | 403 | } |
andrewboyson | 10:e269fd7b9500 | 404 | } |