Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 1 | #include <stdio.h> |
| 2 | #include <stdlib.h> |
| 3 | #include <stdint.h> |
| 4 | #include <string.h> |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 5 | #include <stdbool.h> |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 6 | |
| 7 | #include <osmocom/core/bits.h> |
| 8 | #include <osmocom/core/utils.h> |
| 9 | #include <osmocom/gsm/a5.h> |
| 10 | |
Max | a11994d | 2015-04-06 16:17:49 +0200 | [diff] [blame] | 11 | // make compiler happy |
| 12 | void _a5_3(const uint8_t *key, uint32_t fn, ubit_t *dl, ubit_t *ul, bool fn_correct); |
| 13 | void _a5_4(const uint8_t *key, uint32_t fn, ubit_t *dl, ubit_t *ul, bool fn_correct); |
| 14 | |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 15 | static const uint8_t key[] = { 0x01, 0x23, 0x45, 0x67, 0x89, 0xab, 0xcd, 0xef }; |
| 16 | static const uint32_t fn = 123456; |
| 17 | static const uint8_t dl[] = { |
| 18 | /* A5/0 */ |
| 19 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 20 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 21 | |
| 22 | /* A5/1 */ |
| 23 | 0xcb, 0xa2, 0x55, 0x76, 0x17, 0x5d, 0x3b, 0x1c, |
| 24 | 0x7b, 0x2f, 0x29, 0xa8, 0xc1, 0xb6, 0x00, |
| 25 | |
| 26 | /* A5/2 */ |
| 27 | 0x45, 0x9c, 0x88, 0xc3, 0x82, 0xb7, 0xff, 0xb3, |
| 28 | 0x98, 0xd2, 0xf9, 0x6e, 0x0f, 0x14, 0x80, |
| 29 | }; |
| 30 | static const uint8_t ul[] = { |
| 31 | /* A5/0 */ |
| 32 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 33 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 34 | |
| 35 | /* A5/1 */ |
| 36 | 0xd9, 0x03, 0x5e, 0x0f, 0x2a, 0xec, 0x13, 0x9a, |
| 37 | 0x05, 0xd4, 0xa8, 0x7b, 0xb1, 0x64, 0x80, |
| 38 | |
| 39 | /* A5/2 */ |
| 40 | 0xf0, 0x3a, 0xac, 0xde, 0xe3, 0x5b, 0x5e, 0x65, |
| 41 | 0x80, 0xba, 0xab, 0xc0, 0x59, 0x26, 0x40, |
| 42 | }; |
| 43 | |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 44 | static inline bool print_a5(int n, int k, const char * dir, const ubit_t * out, const char * block) |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 45 | { |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 46 | uint8_t len = 114 / 8 + 1, buf[len], res[len]; |
| 47 | printf("A5/%d - %s: %s => ", n, dir, osmo_ubit_dump(out, 114)); |
| 48 | osmo_hexparse(block, res, len); |
| 49 | osmo_ubit2pbit(buf, out, 114); |
| 50 | if (0 != memcmp(buf, res, len)) { |
Pau Espin Pedrol | 16e205b | 2018-05-16 21:12:12 +0200 | [diff] [blame] | 51 | printf("FAIL:\n"); |
| 52 | printf("GOT: [%d] %s\n", k, osmo_hexdump_nospc(buf, len)); |
| 53 | printf("EXP: [%d] %s\n", k, osmo_hexdump_nospc(res, len)); |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 54 | return false; |
| 55 | } |
| 56 | printf("OK\n"); |
| 57 | return true; |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 58 | } |
| 59 | |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 60 | static inline bool test_a53(const char * kc, uint32_t count, const char * block1, const char * block2) |
| 61 | { |
| 62 | ubit_t dlout[114], ulout[114]; |
| 63 | uint8_t key[8]; |
| 64 | |
| 65 | osmo_hexparse(kc, key, 8); |
| 66 | _a5_3(key, count, dlout, NULL, false); |
| 67 | _a5_3(key, count, NULL, ulout, false); |
| 68 | |
| 69 | return print_a5(3, 8, "DL", dlout, block1) & print_a5(3, 8, "UL", ulout, block2); |
| 70 | } |
| 71 | |
| 72 | static inline bool test_a54(const char * kc, uint32_t count, const char * block1, const char * block2) |
| 73 | { |
| 74 | ubit_t dlout[114], ulout[114]; |
| 75 | uint8_t key[16]; |
| 76 | |
| 77 | osmo_hexparse(kc, key, 16); |
| 78 | _a5_4(key, count, dlout, NULL, false); |
| 79 | _a5_4(key, count, NULL, ulout, false); |
| 80 | |
| 81 | return print_a5(4, 8, "DL", dlout, block1) & print_a5(4, 8, "UL", ulout, block2); |
| 82 | } |
| 83 | |
| 84 | |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 85 | int main(int argc, char **argv) |
| 86 | { |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 87 | ubit_t exp[114], out[114]; |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 88 | int n, i; |
| 89 | |
| 90 | for (n=0; n<3; n++) { |
| 91 | /* "Randomize" */ |
| 92 | for (i=0; i<114; i++) |
| 93 | out[i] = i & 1; |
| 94 | |
| 95 | /* DL */ |
| 96 | osmo_pbit2ubit(exp, &dl[15*n], 114); |
| 97 | |
| 98 | osmo_a5(n, key, fn, out, NULL); |
| 99 | |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 100 | printf("A5/%d - DL: %s", n, osmo_ubit_dump(out, 114)); |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 101 | |
| 102 | if (!memcmp(exp, out, 114)) |
| 103 | printf(" => OK\n"); |
| 104 | else { |
| 105 | printf(" => BAD\n"); |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 106 | printf(" Expected: %s", osmo_ubit_dump(out, 114)); |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 107 | fprintf(stderr, "[!] A5/%d DL failed", n); |
| 108 | exit(1); |
| 109 | } |
| 110 | |
| 111 | /* UL */ |
| 112 | osmo_pbit2ubit(exp, &ul[15*n], 114); |
| 113 | |
| 114 | osmo_a5(n, key, fn, NULL, out); |
| 115 | |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 116 | printf("A5/%d - UL: %s", n, osmo_ubit_dump(out, 114)); |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 117 | |
| 118 | if (!memcmp(exp, out, 114)) |
| 119 | printf(" => OK\n"); |
| 120 | else { |
| 121 | printf(" => BAD\n"); |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 122 | printf(" Expected: %s", osmo_ubit_dump(out, 114)); |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 123 | fprintf(stderr, "[!] A5/%d UL failed", n); |
| 124 | exit(1); |
| 125 | } |
| 126 | } |
| 127 | |
Max | f8699ca | 2015-03-25 17:20:31 +0100 | [diff] [blame] | 128 | // test vectors from 3GPP TS 55.217 and TS 55.218 |
| 129 | test_a53("2BD6459F82C5BC00", 0x24F20F, "889EEAAF9ED1BA1ABBD8436232E440", "5CA3406AA244CF69CF047AADA2DF40"); |
| 130 | test_a53("952C49104881FF48", 0x061272, "FB4D5FBCEE13A33389285686E9A5C0", "25090378E0540457C57E367662E440"); |
| 131 | test_a53("EFA8B2229E720C2A", 0x33FD3F, "0E4015755A336469C3DD8680E30340", "6F10669E2B4E18B042431A28E47F80"); |
| 132 | test_a53("952C49104881FF48", 0x061527, "AB7DB38A573A325DAA76E4CB800A40", "4C4B594FEA9D00FE8978B7B7BC1080"); |
| 133 | test_a53("3451F23A43BD2C87", 0x0E418C, "75F7C4C51560905DFBA05E46FB54C0", "192C95353CDF979E054186DF15BF00"); |
| 134 | test_a53("CAA2639BE82435CF", 0x2FF229, "301437E4D4D6565D4904C631606EC0", "F0A3B8795E264D3E1A82F684353DC0"); |
| 135 | test_a53("7AE67E87400B9FA6", 0x2F24E5, "F794290FEF643D2EA348A7796A2100", "CB6FA6C6B8A705AF9FEFE975818500"); |
| 136 | test_a53("58AF69935540698B", 0x05446B, "749CA4E6B691E5A598C461D5FE4740", "31C9E444CD04677ADAA8A082ADBC40"); |
| 137 | test_a53("017F81E5F236FE62", 0x156B26, "2A6976761E60CC4E8F9F52160276C0", "A544D8475F2C78C35614128F1179C0"); |
| 138 | test_a53("1ACA8B448B767B39", 0x0BC3B5, "A4F70DC5A2C9707F5FA1C60EB10640", "7780B597B328C1400B5C74823E8500"); |
| 139 | test_a54("3D43C388C9581E337FF1F97EB5C1F85E", 0x35D2CF, "A2FE3034B6B22CC4E33C7090BEC340", "170D7497432FF897B91BE8AECBA880"); |
| 140 | test_a54("A4496A64DF4F399F3B4506814A3E07A1", 0x212777, "89CDEE360DF9110281BCF57755A040", "33822C0C779598C9CBFC49183AF7C0"); |
| 141 | |
Sylvain Munaut | 810c334 | 2011-11-17 20:33:19 +0100 | [diff] [blame] | 142 | return 0; |
| 143 | } |