projects/smsdaemon/ModemTransceiver.cpp

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

#include <iostream>
#include <string>
#include <stdexcept>

#include <time.h>


#include "serialport/SerialPort.h"

#include "ModemTransceiver.h"

#include "util.h"
#include "common.h"
#include "Logger.h"

#include "SmsPdu.h"
#include "SmsHelper.h"

using namespace std;


ModemTransceiver::ModemTransceiver(SerialPort& serialport)
: m_port(serialport)
{
}


string ModemTransceiver::GetResponse()
{

        SerialPort::DataBuffer buf;
        m_port.Read(buf);

        buf.push_back(0);

        std::string str((char*) &buf[0]);

        return str;
}


string ModemTransceiver::Command(string command, string term)
{
        time_t  start,now;
        start = time(0);
        _timeout = false;

        if (term != "> ")
                command.append("\r"); //Dont append CarriageReturn if sending SMS

        m_port.Write(command);

        Util::Sleep(1);
        string response = GetResponse();

        unsigned int tlen = term.length();
        while ( 1 )
        {
                if (response.length() >= tlen)
                {
                        if (response.substr(response.length()-tlen,tlen) == term)
                                break;
                }

                response += GetResponse();
                Util::Sleep(1);

        now = time(0);
        if ( (now-start) > 10 )
        {
                Logger::logMessage( string("ModemTransceiver::Command time out --") + command);
                        Logger::logMessage( string("Modem responded: ") + Util::str_trim(response) );
                        _timeout = true;
            break;
        }
        }

        Util::Sleep(5);


        return response;
}

vector<SMS> ModemTransceiver::ReadSms(bool readAll)
{

        Command( "AT+CMGF=0" ); //Set SMS format to PDU

        const string search = "+CMGL: ";
        std::string cmd = "AT+CMGL";
        if (readAll)
                cmd.append("=4");

        string result = Command(cmd);
                
        vector<SMS> retval;
        if (result.find(search) == string::npos)
                return retval;

        result = result.substr(2, result.length() - 8); //remove trailing "\r\nOK\r\n" and initial "\r\n"


        while ( 1 )
        {
                unsigned int endpos = result.find(search,5);

                
                string sms_entry = result.substr(0,endpos);
                retval.push_back( SmsHelper::FromPduString(sms_entry) );;

                if (endpos == string::npos)
                        break;
        
                result = result.substr(endpos, result.length() - endpos);
        }

        return retval;
}


void ModemTransceiver::SendSmsPdu(std::string pdu, int len) //pdu inclussive leading "00"
{
        Logger::logMessage( string("SMS pdu send") );

        Command("AT+CMGF=0");
        Util::Sleep(2);

        string line1 = "AT+CMGS=";
        line1.append( Util::str_formatint(len) );
        line1.append("\r");


        Command(line1,"> ");

        pdu.append("\032"); // \032 == Ctrl+Z
        Command( pdu );
        Util::Sleep( 50 );
        Common::instance()->smsCounter.outgoing++;
}

void ModemTransceiver::SendSms(string to, string message, bool allowMultipart)
{
        Logger::logMessage( string("SMS send to ") + to);

        if (to.at(0) == '+')
                to.erase(0,0);

        vector<PduInfo> pdu_vec = SmsPdu::CreateSmsPdu(to, Util::str_latin2gsm(message), allowMultipart);

        for (unsigned i=0; i<pdu_vec.size(); ++i)
        {
                PduInfo& pdu = pdu_vec[i];

                SendSmsPdu(pdu.pdu, pdu.len);
        }
        Logger::logMessage( "All PDU's send");

}

void ModemTransceiver::DeleteSms(std::string smsIndex)
{
        string cmd = "AT+CMGD=";
        cmd.append(smsIndex);
        Command(cmd);
}

int  ModemTransceiver::DeleteAllSms()
{
        vector<SMS> sms = ReadSms(true);

        for (unsigned int i= 0; i<sms.size(); ++i)
        {
                DeleteSms( sms[i].GetIndex() );
        }
        return sms.size();
}


void ModemTransceiver::WaitForSimcard()
{
        int start = time(0);
        string result;


        while (result != "^SSIM READY")
        {
                result += GetResponse();
                result = Util::str_trim(result);

                if ( (time(0) - start) > 10)
                        throw std::runtime_error("Sim card timed out:");
                Util::Sleep(100);
        }

}

void ModemTransceiver::HandlePincode()
{
        string result = Command("AT+CPIN?");
        result = Util::str_trim(result);
        result.erase(result.length() -2, 2); //remove trailing ok
        result = Util::str_trim(result);
        if (result != "+CPIN: READY")
        {
                if (result == "+CPIN: SIM PIN")
                {
                        Command("AT^SSET=1");
                        result = Command("AT+CPIN=0067");
                        if ( result.substr(result.length()-4, 4) != "OK\r\n")
                                throw std::runtime_error(string("Illegal pincode: ") + result);
                        
                        WaitForSimcard();
                }
                else
                {
                        throw std::runtime_error(string("AT+CPIN? returned unhandled code: ") + result);
                }

        }
}

void ModemTransceiver::Init()
{
        Command( "AT" );
        if (_timeout)
                throw std::runtime_error("Modem did not respond!");

        Command( "ATZ" ); //Reset any previous setup

        Command( "AT\\Q3" ); //Hardware flow control

        Command( "ATE0" ); //Disable echo

        Command ("AT^SM20=0,0" ); //No SM20 compability

        //Command("AT+CGATT=1"); //GPRS Attach

        //Command("AT+CGSMS=2"); //SMS over GPRS preferred

        HandlePincode();
}
1	torben	26	/* using http://sourceforge.net/projects/libserial/
2			*/
3
4			#include <iostream>
5			#include <string>
6			#include <stdexcept>
7
8			#include <time.h>
9
10
11	torben	132	#include "serialport/SerialPort.h"
12	torben	26
13	torben	149	#include "ModemTransceiver.h"
14	torben	26
15			#include "util.h"
16			#include "common.h"
17	torben	157	#include "Logger.h"
18	torben	26
19	torben	63	#include "SmsPdu.h"
20	torben	142	#include "SmsHelper.h"
21	torben	26
22			using namespace std;
23
24
25
26	torben	149	ModemTransceiver::ModemTransceiver(SerialPort& serialport)
27	torben	26	: m_port(serialport)
28			{
29			}
30
31
32
33	torben	149	string ModemTransceiver::GetResponse()
34	torben	26	{
35
36			SerialPort::DataBuffer buf;
37			m_port.Read(buf);
38
39			buf.push_back(0);
40
41			std::string str((char*) &buf[0]);
42
43			return str;
44			}
45
46	torben	34
47	torben	149	string ModemTransceiver::Command(string command, string term)
48	torben	26	{
49			time_t start,now;
50			start = time(0);
51	torben	57	_timeout = false;
52	torben	26
53	torben	34	if (term != "> ")
54			command.append("\r"); //Dont append CarriageReturn if sending SMS
55
56	torben	26	m_port.Write(command);
57
58	torben	34	Util::Sleep(1);
59	torben	26	string response = GetResponse();
60
61			unsigned int tlen = term.length();
62			while ( 1 )
63			{
64			if (response.length() >= tlen)
65			{
66			if (response.substr(response.length()-tlen,tlen) == term)
67			break;
68			}
69
70			response += GetResponse();
71	torben	34	Util::Sleep(1);
72	torben	26
73			now = time(0);
74			if ( (now-start) > 10 )
75			{
76	torben	157	Logger::logMessage( string("ModemTransceiver::Command time out --") + command);
77			Logger::logMessage( string("Modem responded: ") + Util::str_trim(response) );
78	torben	57	_timeout = true;
79	torben	26	break;
80			}
81			}
82
83			Util::Sleep(5);
84
85
86			return response;
87			}
88
89	torben	149	vector<SMS> ModemTransceiver::ReadSms(bool readAll)
90	torben	26	{
91	torben	63
92	torben	75	Command( "AT+CMGF=0" ); //Set SMS format to PDU
93	torben	63
94	torben	26	const string search = "+CMGL: ";
95			std::string cmd = "AT+CMGL";
96			if (readAll)
97	torben	75	cmd.append("=4");
98	torben	26
99			string result = Command(cmd);
100
101			vector<SMS> retval;
102			if (result.find(search) == string::npos)
103			return retval;
104
105			result = result.substr(2, result.length() - 8); //remove trailing "\r\nOK\r\n" and initial "\r\n"
106
107
108			while ( 1 )
109			{
110			unsigned int endpos = result.find(search,5);
111
112
113			string sms_entry = result.substr(0,endpos);
114	torben	142	retval.push_back( SmsHelper::FromPduString(sms_entry) );;
115	torben	26
116			if (endpos == string::npos)
117			break;
118
119			result = result.substr(endpos, result.length() - endpos);
120			}
121
122			return retval;
123			}
124
125	torben	59
126	torben	149	void ModemTransceiver::SendSmsPdu(std::string pdu, int len) //pdu inclussive leading "00"
127	torben	59	{
128	torben	157	Logger::logMessage( string("SMS pdu send") );
129	torben	59
130			Command("AT+CMGF=0");
131			Util::Sleep(2);
132
133			string line1 = "AT+CMGS=";
134			line1.append( Util::str_formatint(len) );
135			line1.append("\r");
136
137
138			Command(line1,"> ");
139
140			pdu.append("\032"); // \032 == Ctrl+Z
141			Command( pdu );
142			Util::Sleep( 50 );
143			Common::instance()->smsCounter.outgoing++;
144			}
145
146	torben	149	void ModemTransceiver::SendSms(string to, string message, bool allowMultipart)
147	torben	26	{
148	torben	157	Logger::logMessage( string("SMS send to ") + to);
149	torben	26
150	torben	63	if (to.at(0) == '+')
151			to.erase(0,0);
152	torben	26
153	torben	135	vector<PduInfo> pdu_vec = SmsPdu::CreateSmsPdu(to, Util::str_latin2gsm(message), allowMultipart);
154	torben	26
155	torben	63	for (unsigned i=0; i<pdu_vec.size(); ++i)
156			{
157			PduInfo& pdu = pdu_vec[i];
158	torben	26
159	torben	63	SendSmsPdu(pdu.pdu, pdu.len);
160	torben	50	}
161	torben	157	Logger::logMessage( "All PDU's send");
162	torben	26
163			}
164
165	torben	149	void ModemTransceiver::DeleteSms(std::string smsIndex)
166	torben	26	{
167			string cmd = "AT+CMGD=";
168			cmd.append(smsIndex);
169			Command(cmd);
170			}
171
172	torben	149	int ModemTransceiver::DeleteAllSms()
173	torben	26	{
174			vector<SMS> sms = ReadSms(true);
175
176			for (unsigned int i= 0; i<sms.size(); ++i)
177			{
178	torben	142	DeleteSms( sms[i].GetIndex() );
179	torben	26	}
180			return sms.size();
181			}
182
183
184
185	torben	149	void ModemTransceiver::WaitForSimcard()
186	torben	105	{
187			int start = time(0);
188			string result;
189
190
191			while (result != "^SSIM READY")
192			{
193			result += GetResponse();
194			result = Util::str_trim(result);
195
196			if ( (time(0) - start) > 10)
197			throw std::runtime_error("Sim card timed out:");
198			Util::Sleep(100);
199			}
200
201			}
202
203	torben	149	void ModemTransceiver::HandlePincode()
204	torben	105	{
205			string result = Command("AT+CPIN?");
206			result = Util::str_trim(result);
207			result.erase(result.length() -2, 2); //remove trailing ok
208			result = Util::str_trim(result);
209			if (result != "+CPIN: READY")
210			{
211			if (result == "+CPIN: SIM PIN")
212			{
213			Command("AT^SSET=1");
214			result = Command("AT+CPIN=0067");
215			if ( result.substr(result.length()-4, 4) != "OK\r\n")
216			throw std::runtime_error(string("Illegal pincode: ") + result);
217
218			WaitForSimcard();
219			}
220			else
221			{
222			throw std::runtime_error(string("AT+CPIN? returned unhandled code: ") + result);
223			}
224
225			}
226			}
227
228	torben	149	void ModemTransceiver::Init()
229	torben	26	{
230	torben	58	Command( "AT" );
231	torben	57	if (_timeout)
232			throw std::runtime_error("Modem did not respond!");
233
234	torben	58	Command( "ATZ" ); //Reset any previous setup
235
236	torben	33	Command( "AT\\Q3" ); //Hardware flow control
237	torben	26
238			Command( "ATE0" ); //Disable echo
239
240			Command ("AT^SM20=0,0" ); //No SM20 compability
241
242	torben	83	//Command("AT+CGATT=1"); //GPRS Attach
243
244			//Command("AT+CGSMS=2"); //SMS over GPRS preferred
245
246	torben	105	HandlePincode();
247	torben	26	}