diff options
author | Paul Kocialkowski <contact@paulk.fr> | 2014-08-07 13:12:15 +0200 |
---|---|---|
committer | Paul Kocialkowski <contact@paulk.fr> | 2014-08-07 13:12:15 +0200 |
commit | a7ff1df1869ce543171a6ee92cbf821647b1bf7d (patch) | |
tree | 659e315b3d609f0f9e661d4de21b52077e6e2b81 /util.c | |
parent | c8408cd2c116b0b99a399282032b6607a1318b84 (diff) | |
download | hardware_ril_samsung-ril-a7ff1df1869ce543171a6ee92cbf821647b1bf7d.zip hardware_ril_samsung-ril-a7ff1df1869ce543171a6ee92cbf821647b1bf7d.tar.gz hardware_ril_samsung-ril-a7ff1df1869ce543171a6ee92cbf821647b1bf7d.tar.bz2 |
Samsung-RIL rewrite: harder, better, probably not faster but definitely stronger
Signed-off-by: Paul Kocialkowski <contact@paulk.fr>
Diffstat (limited to 'util.c')
-rw-r--r-- | util.c | 486 |
1 files changed, 0 insertions, 486 deletions
@@ -1,486 +0,0 @@ -/* - * This file is part of Samsung-RIL. - * - * Copyright (C) 2010-2011 Joerie de Gram <j.de.gram@gmail.com> - * Copyright (C) 2011-2013 Paul Kocialkowski <contact@paulk.fr> - * - * Samsung-RIL is free software: you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation, either version 3 of the License, or - * (at your option) any later version. - * - * Samsung-RIL is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with Samsung-RIL. If not, see <http://www.gnu.org/licenses/>. - */ - -#include <stdio.h> -#include <string.h> -#include <ctype.h> -#include <time.h> - -#define LOG_TAG "RIL-UTIL" -#include <utils/Log.h> -#include "util.h" - -#include "samsung-ril.h" - -/* - * List - */ - -struct list_head *list_head_alloc(void *data, struct list_head *prev, struct list_head *next) -{ - struct list_head *list; - - list = calloc(1, sizeof(struct list_head)); - if (list == NULL) - return NULL; - - list->data = data; - list->prev = prev; - list->next = next; - - if (prev != NULL) - prev->next = list; - if (next != NULL) - next->prev = list; - - return list; -} - -void list_head_free(struct list_head *list) -{ - if (list == NULL) - return; - - if (list->next != NULL) - list->next->prev = list->prev; - if (list->prev != NULL) - list->prev->next = list->next; - - memset(list, 0, sizeof(struct list_head)); - free(list); -} - -/* - * Converts a hexidecimal string to binary - */ -void hex2bin(const char *data, int length, unsigned char *buf) -{ - int i = 0; - char b = 0; - unsigned char *p = buf; - - length ^= 0x01; - - while (i < length) { - b = 0; - - if (data[i] - '0' < 10) - b = data[i] - '0'; - else if (data[i] - 'a' < 7) - b = data[i] - 'a' + 10; - else if (data[i] - 'A' < 7) - b = data[i] - 'A' + 10; - i++; - - b = (b << 4); - - if (data[i] - '0' < 10) - b |= data[i] - '0'; - else if (data[i] - 'a' < 7) - b |= data[i] - 'a' + 10; - else if (data[i] - 'A' < 7) - b |= data[i] - 'A' + 10; - i++; - - *p++ = b; - } -} - -/* - * Converts binary data to a hexidecimal string - */ -void bin2hex(const unsigned char *data, int length, char *buf) -{ - int i; - char b; - char *p = buf; - - for (i = 0; i < length; i++) { - b = 0; - - b = (data[i] >> 4 & 0x0f); - b += (b < 10) ? '0' : ('a' - 10); - *p++ = b; - - b = (data[i] & 0x0f); - b += (b < 10) ? '0' : ('a' - 10); - *p++ = b; - } - - *p = '\0'; -} - -/* - * Converts GSM7 (8 bits) data to ASCII (7 bits) - */ -int gsm72ascii(unsigned char *data, char **data_dec, int length) -{ - int t, u, d, o = 0; - int i; - - int dec_length; - char *dec; - - dec_length = ((length * 8) - ((length * 8) % 7) ) / 7; - dec = malloc(dec_length); - - memset(dec, 0, dec_length); - - for (i = 0 ; i < length ; i++) - { - d = 7 - i % 7; - if (d == 7 && i != 0) - o++; - - t = (data[i] - (((data[i] >> d) & 0xff) << d)); - u = (data[i] >> d) & 0xff; - - dec[i+o]+=t << (i + o) % 8; - - if (u) - dec[i+1+o]+=u; - } - - *data_dec = dec; - - return dec_length; -} - -/* - * Converts ASCII (7 bits) data to GSM7 (8 bits) - */ -int ascii2gsm7_ussd(char *data, unsigned char **data_enc, int length) -{ - int d_off, d_pos, a_off, a_pos = 0; - int i; - - int enc_length; - unsigned char *enc; - - enc_length = ((length * 7) - (length * 7) % 8) / 8; - enc_length += (length * 7) % 8 > 0 ? 1 : 0; - - //FIXME: why does samsung does that? - enc_length++; - - enc = malloc(enc_length); - memset(enc, 0, enc_length); - - for (i = 0 ; i < length ; i++) - { - // offset from the right of data to keep - d_off = i % 8; - - // position of the data we keep - d_pos = ((i * 7) - (i * 7) % 8) / 8; - d_pos += (i * 7) % 8 > 0 ? 1 : 0; - - // adding the data with correct offset - enc[d_pos] |= data[i] >> d_off; - - // numbers of bits to omit to get data to add another place - a_off = 8 - d_off; - // position (on the encoded feed) of the data to add - a_pos = d_pos - 1; - - // adding the data to add at the correct position - enc[a_pos] |= data[i] << a_off; - } - - *data_enc = enc; - - //FIXME: what is going on here? - enc[enc_length - 2] |= 0x30; - enc[enc_length - 1] = 0x02; - - return enc_length; -} - -size_t ascii2gsm7(char *ascii, unsigned char *gsm7) -{ - int ascii_length; - int gsm7_length; - int offset; - - unsigned char *p; - int i; - - if (ascii == NULL) - return -1; - - ascii_length = strlen(ascii); - - gsm7_length = ((ascii_length * 7) - (ascii_length * 7) % 8) / 8; - gsm7_length = (ascii_length * 7) % 8 > 0 ? gsm7_length + 1 : gsm7_length; - - if (gsm7 == NULL) - return gsm7_length; - - memset(gsm7, 0, gsm7_length); - - offset = 0; - p = gsm7; - - for (i = 0; i < ascii_length; i++) { - *p |= ((ascii[i] & 0x7f) >> offset) & 0xff; - - if (offset) { - p--; - *p |= ((ascii[i] & ((1 << (offset + 1)) - 1)) << (8 - offset)) & 0xff; - p++; - } - - if (offset < 7) - p++; - - offset++; - offset %= 8; - } - - return gsm7_length; -} - -void hex_dump(void *data, int size) -{ - /* dumps size bytes of *data to stdout. Looks like: - * [0000] 75 6E 6B 6E 6F 77 6E 20 - * 30 FF 00 00 00 00 39 00 unknown 0.....9. - * (in a single line of course) - */ - - unsigned char *p = data; - unsigned char c; - int n; - char bytestr[4] = {0}; - char addrstr[10] = {0}; - char hexstr[ 16*3 + 5] = {0}; - char charstr[16*1 + 5] = {0}; - for (n=1;n<=size;n++) { - if (n%16 == 1) { - /* store address for this line */ - snprintf(addrstr, sizeof(addrstr), "%.4x", - ((unsigned int)p-(unsigned int)data) ); - } - - c = *p; - if (isalnum(c) == 0) { - c = '.'; - } - - /* store hex str (for left side) */ - snprintf(bytestr, sizeof(bytestr), "%02X ", *p); - strncat(hexstr, bytestr, sizeof(hexstr)-strlen(hexstr)-1); - - /* store char str (for right side) */ - snprintf(bytestr, sizeof(bytestr), "%c", c); - strncat(charstr, bytestr, sizeof(charstr)-strlen(charstr)-1); - - if (n%16 == 0) { - /* line completed */ - RIL_LOGD("[%4.4s] %-50.50s %s", addrstr, hexstr, charstr); - hexstr[0] = 0; - charstr[0] = 0; - } else if (n%8 == 0) { - /* half line: add whitespaces */ - strncat(hexstr, " ", sizeof(hexstr)-strlen(hexstr)-1); - strncat(charstr, " ", sizeof(charstr)-strlen(charstr)-1); - } - p++; /* next byte */ - } - - if (strlen(hexstr) > 0) { - /* print rest of buffer if not empty */ - RIL_LOGD("[%4.4s] %-50.50s %s\n", addrstr, hexstr, charstr); - } -} - -/* writes the utf8 character encoded in v - * to the buffer utf8 at the specified offset - */ -int utf8_write(char *utf8, int offset, int v) -{ - - int result; - - if (v < 0x80) { - result = 1; - if (utf8) - utf8[offset] = (char)v; - } else if (v < 0x800) { - result = 2; - if (utf8) { - utf8[offset + 0] = (char)(0xc0 | (v >> 6)); - utf8[offset + 1] = (char)(0x80 | (v & 0x3f)); - } - } else if (v < 0x10000) { - result = 3; - if (utf8) { - utf8[offset + 0] = (char)(0xe0 | (v >> 12)); - utf8[offset + 1] = (char)(0x80 | ((v >> 6) & 0x3f)); - utf8[offset + 2] = (char)(0x80 | (v & 0x3f)); - } - } else { - result = 4; - if (utf8) { - utf8[offset + 0] = (char)(0xf0 | ((v >> 18) & 0x7)); - utf8[offset + 1] = (char)(0x80 | ((v >> 12) & 0x3f)); - utf8[offset + 2] = (char)(0x80 | ((v >> 6) & 0x3f)); - utf8[offset + 3] = (char)(0x80 | (v & 0x3f)); - } - } - return result; -} - -SmsCodingScheme sms_get_coding_scheme(int dataCoding) -{ - switch (dataCoding >> 4) { - case 0x00: - case 0x02: - case 0x03: - return SMS_CODING_SCHEME_GSM7; - case 0x01: - if (dataCoding == 0x10) - return SMS_CODING_SCHEME_GSM7; - if (dataCoding == 0x11) - return SMS_CODING_SCHEME_UCS2; - break; - case 0x04: - case 0x05: - case 0x06: - case 0x07: - if (dataCoding & 0x20) - return SMS_CODING_SCHEME_UNKNOWN; - if (((dataCoding >> 2) & 3) == 0) - return SMS_CODING_SCHEME_GSM7; - if (((dataCoding >> 2) & 3) == 2) - return SMS_CODING_SCHEME_UCS2; - break; - case 0xF: - if (!(dataCoding & 4)) - return SMS_CODING_SCHEME_GSM7; - break; - } - return SMS_CODING_SCHEME_UNKNOWN; -} - -char *pdu_create(char *number, char *message) -{ - unsigned char pdu_first[] = { 0x00, 0x04 }; - unsigned char pdu_toa[] = { 0x91 }; - unsigned char pdu_tp[] = { 0x00, 0x00 }; - unsigned char timestamp[7] = { 0 }; - time_t t; - struct tm *tm; - - unsigned char number_length; - unsigned char message_length; - - unsigned char *buffer = NULL; - char *pdu = NULL; - size_t length = 0; - - unsigned char *p; - unsigned char a; - char c; - int i; - - if (number == NULL || message == NULL || strlen(message) > 0xff) - return NULL; - - number_length = strlen(number) & 0xff; - if (number_length % 2 != 0) - number_length++; - number_length /= 2; - - message_length = ascii2gsm7(message, NULL) & 0xff; - - length = sizeof(pdu_first) + sizeof(number_length) + sizeof(pdu_toa) + number_length + sizeof(pdu_tp) + sizeof(timestamp) + sizeof(message_length) + message_length; - buffer = calloc(1, length); - - p = (unsigned char *) buffer; - - memcpy(p, &pdu_first, sizeof(pdu_first)); - p += sizeof(pdu_first); - - number_length = strlen(number) & 0xff; - - memcpy(p, &number_length, sizeof(number_length)); - p += sizeof(number_length); - memcpy(p, &pdu_toa, sizeof(pdu_toa)); - p += sizeof(pdu_toa); - - i = 0; - while (i < number_length) { - c = number[i++]; - - if (isdigit(c)) - *p = (c - '0') & 0x0f; - - if (i < number_length) { - c = number[i++]; - if (isdigit(c)) - *p |= ((c - '0') & 0x0f) << 4; - } else { - *p |= 0xf << 4; - } - - p++; - } - - memcpy(p, &pdu_tp, sizeof(pdu_tp)); - p += sizeof(pdu_tp); - - t = time(NULL); - tm = localtime(&t); - - a = (tm->tm_year - 100); - timestamp[0] = ((a - (a % 10)) / 10) | ((a % 10) * 0x10); - a = (tm->tm_mon + 1); - timestamp[1] = ((a - (a % 10)) / 10) | ((a % 10) * 0x10); - a = tm->tm_mday; - timestamp[2] = ((a - (a % 10)) / 10) | ((a % 10) * 0x10); - a = tm->tm_hour; - timestamp[3] = ((a - (a % 10)) / 10) | ((a % 10) * 0x10); - a = tm->tm_min; - timestamp[4] = ((a - (a % 10)) / 10) | ((a % 10) * 0x10); - a = tm->tm_sec; - timestamp[5] = ((a - (a % 10)) / 10) | ((a % 10) * 0x10); - a = (unsigned char) (-timezone / 900); - timestamp[6] = ((a - (a % 10)) / 10) | ((a % 10) * 0x10); - - memcpy(p, ×tamp, sizeof(timestamp)); - p += sizeof(timestamp); - - message_length = strlen(message) & 0xff; - - memcpy(p, &message_length, sizeof(message_length)); - p += sizeof(message_length); - - ascii2gsm7(message, p); - p += message_length; - - pdu = (char *) calloc(1, length * 2 + 1); - - bin2hex(buffer, length, pdu); - - free(buffer); - - return pdu; -} |