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