#if HAVE_CRT #define _CRTDBG_MAP_ALLOC #include #include #endif //HAVE_CRT /* * Copyright (C) 2020, University of the Basque Country (UPV/EHU) * Contact for licensing options: * * The original file was part of Open Source Doubango Framework * Copyright (C) 2010-2011 Mamadou Diop. * Copyright (C) 2012 Doubango Telecom * * This file is part of Open Source Doubango Framework. * * DOUBANGO 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. * * DOUBANGO 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 DOUBANGO. * */ /**@file tsms_packing.c * @brief SMS Packing (3GPP TS 23.038 subclause 6.1.2). * * @author Mamadou Diop * */ #include "tinysms/tsms_packing.h" #include "tinysms/tsms_etsi_gsm_03_38.h" #include "tsk_memory.h" #include "tsk_string.h" #include "tsk_debug.h" #include /* strlen() */ /**@defgroup tsms_packing_group SMS Packing */ /**@ingroup tsms_packing_group * Converts ASCII string to GSM 7-bit characters as per 3GPP TS 23.038 v911 section 6.1.2.1. * @param ascii Null-Terminated ascii string to convert. * @retval Buffer containing GSM 7-bit characters if succeed and @a Null otherwise. * @sa @ref tsms_pack_from_7bit */ tsk_buffer_t* tsms_pack_to_7bit(const char* ascii) { /* 3GPP TS 23.038 - 6.1.2.1.1 Packing of 7-bit characters If a character number $ is noted in the following way: b7 b6 b5 b4 b3 b2 b1 $a $b $c $d $e $f $g The packing of the 7-bitscharacters in octets is done by completing the octets with zeros on the left. For examples, packing: $ - one character in one octet: - bits number: 7 6 5 4 3 2 1 0 0 1a 1b 1c 1d 1e 1f 1g - two characters in two octets: - bits number: 7 6 5 4 3 2 1 0 2g 1a 1b 1c 1d 1e 1f 1g 0 0 2a 2b 2c 2d 2e 2f - three characters in three octets: - bits number: 7 6 5 4 3 2 1 0 2g 1a 1b 1c 1d 1e 1f 1g 3f 3g 2a 2b 2c 2d 2e 2f 0 0 0 3a 3b 3c 3d 3e - seven characters in seven octets: - bits number: 7 6 5 4 3 2 1 0 2g 1a 1b 1c 1d 1e 1f 1g 3f 3g 2a 2b 2c 2d 2e 2f 4e 4f 4g 3a 3b 3c 3d 3e 5d 5e 5f 5g 4a 4b 4c 4d 6c 6d 6e 6f 6g 5a 5b 5c 7b 7c 7d 7e 7f 7g 6a 6b 0 0 0 0 0 0 0 7a - eight characters in seven octets: - bits number: 7 6 5 4 3 2 1 0 2g 1a 1b 1c 1d 1e 1f 1g 3f 3g 2a 2b 2c 2d 2e 2f 4e 4f 4g 3a 3b 3c 3d 3e 5d 5e 5f 5g 4a 4b 4c 4d 6c 6d 6e 6f 6g 5a 5b 5c 7b 7c 7d 7e 7f 7g 6a 6b 8a 8b 8c 8d 8e 8f 8g 7a The bit number zero is always transmitted first. Therefore, in 140 octets, it is possible to pack (140x8)/7=160 characters. */ tsk_buffer_t* ret = tsk_null; uint8_t* _ret = tsk_null; register tsk_size_t len, bcount = 1/*1-7*/, index = 0, retindex = 0, retlen = 0; const uint8_t* pascii = (const uint8_t*)ascii; if(!ascii || !(len = strlen(ascii))){ TSK_DEBUG_WARN("Null or Empty ascci string."); goto bail; } retlen = len - (len/7) + 1; #if HAVE_CRT //Debug memory if(!(_ret = calloc(retlen, sizeof(uint8_t)))){ #else if(!(_ret = tsk_calloc(retlen, sizeof(uint8_t)))){ #endif //HAVE_CRT goto bail; } while(index < len){ if(index == 0){ _ret[retindex] |= (pascii[index] & (0xFF >> bcount)) | (pascii[index+1] << (8 - bcount)); } else{ _ret[retindex] = ((pascii[index] >> (bcount - 1))& (0xFF >> bcount)) | (pascii[index+1] <<(8-bcount)); } /* how many bytes to use to complete on the left? */ if(++bcount == 8){ bcount = 1, ++index; } /* next */ retindex++; index++; } /* creat ret */ ret = tsk_buffer_create(_ret, (retlen-1)); bail: TSK_FREE(_ret); return ret; } /**@ingroup tsms_packing_group * Converts ASCII string to UCS-2(2-byte Universal Character Set) characters. * @param ascii Null-Terminated ascii string to convert. * @retval Buffer containing UCS-2 characters if succeed and @a Null otherwise. * @sa @ref tsms_pack_from_ucs2 */ tsk_buffer_t* tsms_pack_to_ucs2(const char* ascii) { register tsk_size_t i, j; tsk_size_t len, retlen = 0; uint8_t* str = tsk_null; tsk_buffer_t* ret = tsk_null; if(!ascii || !(len=strlen(ascii))){ TSK_DEBUG_WARN("Null or Empty gsm7bit buffer."); goto bail; } #if HAVE_CRT //Debug memory if(!(str = calloc(len, sizeof(uint8_t)*2))){ #else if(!(str = tsk_calloc(len, sizeof(uint8_t)*2))){ #endif //HAVE_CRT goto bail; } /* very bas way to do conversion ==> to be fixed */ for(i=0; i to be fixed */ for(i = 0; i>bcount)); if(index){ ret[retindex] = (ret[retindex] << (bcount - 1)) | (pgsm7bit[index-1] >> (8 - bcount + 1)); } /* how many bytes to use to complete on the right? */ if(bcount++ == 8){ bcount = 1, --index; } /* next */ index++; retindex++; } /* special one */ if(!(size%7)){ ret[retindex] = pgsm7bit[size-1]>>1; } bail: return ret; } /**@ingroup tsms_packing_group * Converts UCS-2(2-byte Universal Character Set) characters to ASCII string. * @param ucs2 Buffer containing UCS-2 characters to convert. * @param size The size of the buffer. * @retval Null-terminated ASCII string, ready to be shown to the screen. * @sa @ref tsms_pack_to_ucs2 */ char* tsms_pack_from_ucs2(const void* ucs2, tsk_size_t size) { register tsk_size_t i, j; char* ret = tsk_null; const uint16_t* pucs2 = ucs2; if(!ucs2 || !size){ TSK_DEBUG_WARN("Null or Empty gsm8bit buffer."); goto bail; } #if HAVE_CRT //Debug memory if(!(ret = calloc(size+1, sizeof(uint8_t)))){ #else if(!(ret = tsk_calloc(size+1, sizeof(uint8_t)))){ #endif //HAVE_CRT goto bail; } for(i=0; i to be changed */ for(i=0; i