--- smsdaemon/GsmModem.cpp	2008/06/11 10:31:42	50
+++ smsdaemon/GsmModem.cpp	2008/12/07 16:27:34	144
@@ -2,22 +2,21 @@
  */
 
 #include <iostream>
-
 #include <string>
-#include <cstring>
 #include <stdexcept>
 
-#include <sys/time.h>
 #include <time.h>
 
 
-#include "SerialPort.h"
+#include "serialport/SerialPort.h"
 
 #include "GsmModem.h"
 
 #include "util.h"
 #include "common.h"
 
+#include "SmsPdu.h"
+#include "SmsHelper.h"
 
 using namespace std;
 
@@ -26,7 +25,6 @@
 GsmModem::GsmModem(SerialPort& serialport)
 : m_port(serialport)
 {
-	Init();
 }
 
 
@@ -49,6 +47,7 @@
 {
 	time_t  start,now;
 	start = time(0);
+	_timeout = false;
 
 	if (term != "> ")
 		command.append("\r"); //Dont append CarriageReturn if sending SMS
@@ -74,24 +73,27 @@
         if ( (now-start) > 10 )
         {
 	       	Common::instance()->logMessage( string("GsmModem::Command time out --") + command);
+			Common::instance()->logMessage( string("Modem responded: ") + Util::str_trim(response) );
+			_timeout = true;
             break;
         }
 	}
 
 	Util::Sleep(5);
 
-//	cout  << response.length() << ":" << response << endl;
-//	DumpString(response);
 
 	return response;
 }
 
 vector<SMS> GsmModem::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("=ALL");
+		cmd.append("=4");
 
 	string result = Command(cmd);
 		
@@ -108,7 +110,7 @@
 
 		
 		string sms_entry = result.substr(0,endpos);
-		retval.push_back( SMS::FromRawString(sms_entry) );;
+		retval.push_back( SmsHelper::FromPduString(sms_entry) );;
 
 		if (endpos == string::npos)
 			break;
@@ -119,32 +121,44 @@
 	return retval;
 }
 
-void GsmModem::SendSms(string to, string message)
+
+void GsmModem::SendSmsPdu(std::string pdu, int len) //pdu inclussive leading "00"
 {
-	Common::instance()->logMessage( string("SMS send to ") + to);
+	Common::instance()->logMessage( string("SMS pdu send") );
 
-	Command("AT+CMGF=1");///Allways telling the format makes the application more stable
+	Command("AT+CMGF=0");
 	Util::Sleep(2);
 
 	string line1 = "AT+CMGS=";
-	line1.append(to);
+	line1.append( Util::str_formatint(len) );
 	line1.append("\r");
 
+
 	Command(line1,"> ");
 
-	if (message.length() > 160)
-	{
-		message = message.substr(0,160);
-		Common::instance()->logMessage( "Trunkating message! ");
-	}
+	pdu.append("\032"); // \032 == Ctrl+Z
+	Command( pdu );
+	Util::Sleep( 50 );
+	Common::instance()->smsCounter.outgoing++;
+}
 
-	message.append("\032"); // \032 == Ctrl+Z
+void GsmModem::SendSms(string to, string message, bool allowMultipart)
+{
+	Common::instance()->logMessage( string("SMS send to ") + to);
 
-	Command( message ); //In textmode limit to 160 bytes
+	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);
+	}
+	Common::instance()->logMessage( "All PDU's send");
 
-	Util::Sleep(50); //Give the modem some time to send the sms and be ready again
-	Common::instance()->smsCounter.outgoing++;
 }
 
 void GsmModem::DeleteSms(std::string smsIndex)
@@ -160,25 +174,98 @@
 
 	for (unsigned int i= 0; i<sms.size(); ++i)
 	{
-		DeleteSms( sms[i].sms_index);
+		DeleteSms( sms[i].GetIndex() );
 	}
 	return sms.size();
 }
 
 
 
+void GsmModem::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 GsmModem::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 GsmModem::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+CMGF=1" ); //Set SMS format to text
-
 	Command ("AT^SM20=0,0" ); //No SM20 compability
 
-	//Set RealTimeClock ??
-	
-	//Enter pin code ??
+	//Command("AT+CGATT=1"); //GPRS Attach
+
+	//Command("AT+CGSMS=2"); //SMS over GPRS preferred
+
+	HandlePincode();
+}
+
+
+
+
+void DebugGsmModem::SendSms(std::string to, std::string message, bool allowMultipart) 
+{
+	_to=to; 
+	_message = message; 
+	_multipart = allowMultipart;
+
+	if (_print)
+	{
+		cout << "DebugGsmModem::SendSms --------------" << endl;
+		cout << "To:        " << to << endl;;
+		cout << "Message:   " << message << endl;
+		cout << "Multipart: " << allowMultipart << endl;
+
+	}
+}
+
+std::vector<SMS> DebugGsmModem::ReadSms(bool readAll)
+{
+	vector<SMS> result;
+	return result;
 }