Tom Tsou | 9a5bbf3 | 2016-07-14 15:13:45 -0700 | [diff] [blame] | 1 | #include <errno.h> |
| 2 | #include <string.h> |
| 3 | |
| 4 | #include <osmocom/gprs/gprs_rlc.h> |
Max | c8cf820 | 2017-05-22 16:07:04 +0200 | [diff] [blame] | 5 | #include <osmocom/coding/gsm0503_coding.h> |
Tom Tsou | 9a5bbf3 | 2016-07-14 15:13:45 -0700 | [diff] [blame] | 6 | #include <osmocom/gprs/protocol/gsm_04_60.h> |
| 7 | |
| 8 | #define EGPRS_CPS_TYPE1_TBL_SZ 29 |
| 9 | #define EGPRS_CPS_TYPE2_TBL_SZ 8 |
| 10 | #define EGPRS_CPS_TYPE3_TBL_SZ 16 |
| 11 | |
| 12 | /* 3GPP TS 44.060 10.4.8a.1.1 "Header type 1" */ |
| 13 | static const struct egprs_cps egprs_cps_table_type1[EGPRS_CPS_TYPE1_TBL_SZ] = { |
Max | c8cf820 | 2017-05-22 16:07:04 +0200 | [diff] [blame] | 14 | { .bits = 0, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P1, EGPRS_CPS_P1 } }, |
| 15 | { .bits = 1, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P1, EGPRS_CPS_P2 } }, |
| 16 | { .bits = 2, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P1, EGPRS_CPS_P3 } }, |
| 17 | { .bits = 3, .mcs = EGPRS_NUM_MCS, .p = { EGPRS_CPS_NONE, EGPRS_CPS_NONE } }, /* reserved for future use */ |
| 18 | { .bits = 4, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P2, EGPRS_CPS_P1 } }, |
| 19 | { .bits = 5, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P2, EGPRS_CPS_P2 } }, |
| 20 | { .bits = 6, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P2, EGPRS_CPS_P3 } }, |
| 21 | { .bits = 7, .mcs = EGPRS_NUM_MCS, .p = { EGPRS_CPS_NONE, EGPRS_CPS_NONE } }, /* reserved for future use */ |
| 22 | { .bits = 8, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P3, EGPRS_CPS_P1 } }, |
| 23 | { .bits = 9, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P3, EGPRS_CPS_P2 } }, |
| 24 | { .bits = 10, .mcs = EGPRS_MCS9, .p = { EGPRS_CPS_P3, EGPRS_CPS_P3 } }, |
| 25 | { .bits = 11, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P1, EGPRS_CPS_P1 } }, |
| 26 | { .bits = 12, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P1, EGPRS_CPS_P2 } }, |
| 27 | { .bits = 13, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P1, EGPRS_CPS_P3 } }, |
| 28 | { .bits = 14, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P2, EGPRS_CPS_P1 } }, |
| 29 | { .bits = 15, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P2, EGPRS_CPS_P2 } }, |
| 30 | { .bits = 16, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P2, EGPRS_CPS_P3 } }, |
| 31 | { .bits = 17, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P3, EGPRS_CPS_P1 } }, |
| 32 | { .bits = 18, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P3, EGPRS_CPS_P2 } }, |
| 33 | { .bits = 19, .mcs = EGPRS_MCS8, .p = { EGPRS_CPS_P3, EGPRS_CPS_P3 } }, |
| 34 | { .bits = 20, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P1, EGPRS_CPS_P1 } }, |
| 35 | { .bits = 21, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P1, EGPRS_CPS_P2 } }, |
| 36 | { .bits = 22, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P1, EGPRS_CPS_P3 } }, |
| 37 | { .bits = 23, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P2, EGPRS_CPS_P1 } }, |
| 38 | { .bits = 24, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P2, EGPRS_CPS_P2 } }, |
| 39 | { .bits = 25, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P2, EGPRS_CPS_P3 } }, |
| 40 | { .bits = 26, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P3, EGPRS_CPS_P1 } }, |
| 41 | { .bits = 27, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P3, EGPRS_CPS_P2 } }, |
| 42 | { .bits = 28, .mcs = EGPRS_MCS7, .p = { EGPRS_CPS_P3, EGPRS_CPS_P3 } }, |
Tom Tsou | 9a5bbf3 | 2016-07-14 15:13:45 -0700 | [diff] [blame] | 43 | }; |
| 44 | |
| 45 | /* |
| 46 | * 3GPP TS 44.060 10.4.8a.2.1 |
| 47 | * "Header type 2 in EGPRS TBF or uplink EGPRS2-A TBF" |
| 48 | */ |
| 49 | static const struct egprs_cps egprs_cps_table_type2[EGPRS_CPS_TYPE2_TBL_SZ] = { |
Max | c8cf820 | 2017-05-22 16:07:04 +0200 | [diff] [blame] | 50 | { .bits = 0, .mcs = EGPRS_MCS6, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 51 | { .bits = 1, .mcs = EGPRS_MCS6, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 52 | { .bits = 2, .mcs = EGPRS_MCS6, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 53 | { .bits = 3, .mcs = EGPRS_MCS6, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 54 | { .bits = 4, .mcs = EGPRS_MCS5, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 55 | { .bits = 5, .mcs = EGPRS_MCS5, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 56 | { .bits = 6, .mcs = EGPRS_MCS6, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 57 | { .bits = 7, .mcs = EGPRS_MCS6, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
Tom Tsou | 9a5bbf3 | 2016-07-14 15:13:45 -0700 | [diff] [blame] | 58 | }; |
| 59 | |
| 60 | /* 3GPP TS 44.060 10.4.8a.3 "Header type 3" */ |
| 61 | static const struct egprs_cps egprs_cps_table_type3[EGPRS_CPS_TYPE3_TBL_SZ] = { |
Max | c8cf820 | 2017-05-22 16:07:04 +0200 | [diff] [blame] | 62 | { .bits = 0, .mcs = EGPRS_MCS4, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 63 | { .bits = 1, .mcs = EGPRS_MCS4, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 64 | { .bits = 2, .mcs = EGPRS_MCS4, .p = { EGPRS_CPS_P3, EGPRS_CPS_NONE } }, |
| 65 | { .bits = 3, .mcs = EGPRS_MCS3, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 66 | { .bits = 4, .mcs = EGPRS_MCS3, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 67 | { .bits = 5, .mcs = EGPRS_MCS3, .p = { EGPRS_CPS_P3, EGPRS_CPS_NONE } }, |
| 68 | { .bits = 6, .mcs = EGPRS_MCS3, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 69 | { .bits = 7, .mcs = EGPRS_MCS3, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 70 | { .bits = 8, .mcs = EGPRS_MCS3, .p = { EGPRS_CPS_P3, EGPRS_CPS_NONE } }, |
| 71 | { .bits = 9, .mcs = EGPRS_MCS2, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 72 | { .bits = 10, .mcs = EGPRS_MCS2, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 73 | { .bits = 11, .mcs = EGPRS_MCS1, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 74 | { .bits = 12, .mcs = EGPRS_MCS1, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 75 | { .bits = 13, .mcs = EGPRS_MCS2, .p = { EGPRS_CPS_P1, EGPRS_CPS_NONE } }, |
| 76 | { .bits = 14, .mcs = EGPRS_MCS2, .p = { EGPRS_CPS_P2, EGPRS_CPS_NONE } }, |
| 77 | { .bits = 15, .mcs = EGPRS_MCS0, .p = { EGPRS_CPS_NONE, EGPRS_CPS_NONE } }, |
Tom Tsou | 9a5bbf3 | 2016-07-14 15:13:45 -0700 | [diff] [blame] | 78 | }; |
| 79 | |
| 80 | int egprs_get_cps(struct egprs_cps *cps, uint8_t type, uint8_t bits) |
| 81 | { |
| 82 | const struct egprs_cps *table_cps; |
| 83 | |
| 84 | switch (type) { |
| 85 | case EGPRS_HDR_TYPE1: |
| 86 | if (bits >= EGPRS_CPS_TYPE1_TBL_SZ) |
| 87 | return -EINVAL; |
| 88 | table_cps = &egprs_cps_table_type1[bits]; |
| 89 | break; |
| 90 | case EGPRS_HDR_TYPE2: |
| 91 | if (bits >= EGPRS_CPS_TYPE2_TBL_SZ) |
| 92 | return -EINVAL; |
| 93 | table_cps = &egprs_cps_table_type2[bits]; |
| 94 | break; |
| 95 | case EGPRS_HDR_TYPE3: |
| 96 | if (bits >= EGPRS_CPS_TYPE3_TBL_SZ) |
| 97 | return -EINVAL; |
| 98 | table_cps = &egprs_cps_table_type3[bits]; |
| 99 | break; |
| 100 | default: |
| 101 | return -EINVAL; |
| 102 | } |
| 103 | |
| 104 | memcpy(cps, table_cps, sizeof *cps); |
| 105 | |
| 106 | return 0; |
| 107 | } |