projects/smsdaemon/SmsPdu.cpp

/* using http://sourceforge.net/projects/libserial/
 */


#include <string>
#include <sstream>


#include "util.h"


using namespace std;


namespace SmsPdu
{


vector<unsigned char> BcdEncode(string input)
{
        char buf[2] = " ";
        vector<unsigned char> result;

        unsigned char current;
        for (unsigned int i=0; i<input.length(); ++i)
        {
                buf[0] = input.at(i);
                unsigned char tmp = atoi(buf);

                if ( (i%2) == 0)
                {
                        current = tmp;
                }
                else
                {
                        current |= (tmp<<4);
                        result.push_back(current);
                }
        }

        return result;
}

string HexformatVector(vector<unsigned char> vec)
{
        ostringstream os;

        for (unsigned int i=0; i<vec.size(); ++i)
        {
                os.width(2);
                os.fill('0');
                os << hex << uppercase << static_cast<unsigned int>(vec.at(i));
        }


        return os.str();
}

vector<unsigned char> Encode7to8bit(std::string str)
{
        vector<unsigned char> buf;

        int shift = 0;
        for (unsigned int i=0; i<str.size(); ++i)
        {
                unsigned char current = str.at(i) & 0x7F;
                unsigned char next = ( (i+1)<str.size()) ? str.at(i+1) : 0;
                next &= 0x7F;

                current >>= shift;
                next <<= (7-shift);

                unsigned char byte = current | next;
                buf.push_back(byte);

                if (shift == 6)
                        i++;

                shift = (shift+1) % 7;

        }

        return buf;
}

string CreateSmsPdu(string to, string message, int& len)
{
        message = message.substr(0,160); //truncate to 160

        vector<unsigned char> pdu;

        pdu.push_back(0x00); // use SMSC from phone
        pdu.push_back(0x01); // first octet -- no timeout
        pdu.push_back(0x00); // TP-MR message reference
        pdu.push_back(to.length() ); //length of phone nr
        pdu.push_back(0x91); // type of address (international nr  + ISDN/telephone range) - else try 0x81

        vector<unsigned char> phone = BcdEncode(to);
        pdu.insert( pdu.end(), phone.begin(), phone.end());

        pdu.push_back(0x00); // Protocol identifier
        pdu.push_back(0x00); // Data coding scheme
        pdu.push_back( message.length() ); //UserDataLength

        vector<unsigned char> userData = Encode7to8bit(message);
        pdu.insert( pdu.end(), userData.begin(), userData.end());

        len = pdu.size()-1;
        return HexformatVector(pdu);
}

}
1	torben	59	/* using http://sourceforge.net/projects/libserial/
2			*/
3
4
5			#include <string>
6			#include <sstream>
7
8
9
10
11			#include "util.h"
12
13
14			using namespace std;
15
16
17			namespace SmsPdu
18			{
19
20
21			vector<unsigned char> BcdEncode(string input)
22			{
23			char buf[2] = " ";
24			vector<unsigned char> result;
25
26			unsigned char current;
27			for (unsigned int i=0; i<input.length(); ++i)
28			{
29			buf[0] = input.at(i);
30			unsigned char tmp = atoi(buf);
31
32			if ( (i%2) == 0)
33			{
34			current = tmp;
35			}
36			else
37			{
38			current \|= (tmp<<4);
39			result.push_back(current);
40			}
41			}
42
43			return result;
44			}
45
46			string HexformatVector(vector<unsigned char> vec)
47			{
48			ostringstream os;
49
50			for (unsigned int i=0; i<vec.size(); ++i)
51			{
52			os.width(2);
53			os.fill('0');
54			os << hex << uppercase << static_cast<unsigned int>(vec.at(i));
55			}
56
57
58			return os.str();
59			}
60
61			vector<unsigned char> Encode7to8bit(std::string str)
62			{
63			vector<unsigned char> buf;
64
65			int shift = 0;
66			for (unsigned int i=0; i<str.size(); ++i)
67			{
68			unsigned char current = str.at(i) & 0x7F;
69			unsigned char next = ( (i+1)<str.size()) ? str.at(i+1) : 0;
70			next &= 0x7F;
71
72			current >>= shift;
73			next <<= (7-shift);
74
75			unsigned char byte = current \| next;
76			buf.push_back(byte);
77
78			if (shift == 6)
79			i++;
80
81			shift = (shift+1) % 7;
82
83			}
84
85			return buf;
86			}
87
88			string CreateSmsPdu(string to, string message, int& len)
89			{
90			message = message.substr(0,160); //truncate to 160
91
92			vector<unsigned char> pdu;
93
94			pdu.push_back(0x00); // use SMSC from phone
95			pdu.push_back(0x01); // first octet -- no timeout
96			pdu.push_back(0x00); // TP-MR message reference
97			pdu.push_back(to.length() ); //length of phone nr
98			pdu.push_back(0x91); // type of address (international nr + ISDN/telephone range) - else try 0x81
99
100			vector<unsigned char> phone = BcdEncode(to);
101			pdu.insert( pdu.end(), phone.begin(), phone.end());
102
103			pdu.push_back(0x00); // Protocol identifier
104			pdu.push_back(0x00); // Data coding scheme
105			pdu.push_back( message.length() ); //UserDataLength
106
107			vector<unsigned char> userData = Encode7to8bit(message);
108			pdu.insert( pdu.end(), userData.begin(), userData.end());
109
110			len = pdu.size()-1;
111			return HexformatVector(pdu);
112			}
113
114			}