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