summaryrefslogtreecommitdiffabout
path: root/gammu/emb/common/phone/nokia/dct3/n6110.c
Side-by-side diff
Diffstat (limited to 'gammu/emb/common/phone/nokia/dct3/n6110.c') (more/less context) (ignore whitespace changes)
-rw-r--r--gammu/emb/common/phone/nokia/dct3/n6110.c2884
1 files changed, 2884 insertions, 0 deletions
diff --git a/gammu/emb/common/phone/nokia/dct3/n6110.c b/gammu/emb/common/phone/nokia/dct3/n6110.c
new file mode 100644
index 0000000..263d12b
--- a/dev/null
+++ b/gammu/emb/common/phone/nokia/dct3/n6110.c
@@ -0,0 +1,2884 @@
+/* (c) 2001-2004 by Marcin Wiacek */
+/* based on some work from Markus Plail and Gnokii */
+/* Authentication function (c) 1999 or earlier by Pavel Janik */
+/* 5210 calendar IDs by Frederick Ros */
+
+#include "../../../gsmstate.h"
+
+#ifdef GSM_ENABLE_NOKIA6110
+
+#include <string.h>
+
+#include "../../../../cfg/config.h"
+#include "../../../misc/coding/coding.h"
+#include "../../../service/sms/gsmsms.h"
+#include "../../../gsmcomon.h"
+#include "../../pfunc.h"
+#include "../nfunc.h"
+#include "n6110.h"
+#include "dct3func.h"
+
+static unsigned char N6110_MEMORY_TYPES[] = {
+ MEM_ME, 0x02,
+ MEM_SM, 0x03,
+ MEM_ON, 0x05,
+ MEM_DC, 0x07,
+ MEM_RC, 0x08,
+ MEM_MC, 0x09,
+ MEM_VM, 0x0b,
+ 0x00, 0x00
+};
+
+static GSM_Error N6110_ReplyGetPhoneLanguage(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ N6110_Language lang = N6110_Auto;
+
+ if (msg.Buffer[3] == 0x15) return ERR_NONE;
+
+ smprintf(s, "Phone language is %02x\n",msg.Buffer[6]);
+ switch (msg.Buffer[6]) {
+ case 0x21: lang = N6110_Europe; break; //Polish
+ }
+ s->Phone.Data.Priv.N6110.PhoneLanguage = lang;
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_GetPhoneLanguage(GSM_StateMachine *s)
+{
+ unsigned char feat_req[] = {N6110_FRAME_HEADER, 0x13, 0x01,
+ 0x00, /* Profile location */
+ 0x00}; /* Feature number */
+
+ s->Phone.Data.Priv.N6110.PhoneLanguage = N6110_Auto;
+
+ feat_req[5] = 0;
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES33)) {
+ feat_req[6] = 0x1E;
+ } else {
+ feat_req[6] = 0x21;
+ }
+ smprintf(s, "Getting profile feature\n");
+ return GSM_WaitFor (s, feat_req, 7, 0x05, 4, ID_GetLanguage);
+}
+
+struct N6110_Lang_Char {
+ N6110_Language Lang;
+ unsigned char Phone;
+ unsigned char Unicode1;
+ unsigned char Unicode2;
+};
+
+static struct N6110_Lang_Char N6110_Lang_Table[] = {
+{N6110_Europe,0x13,0x01,0x04},//Latin capital letter a with ogonek
+{N6110_Europe,0x14,0x01,0x05},//Latin small letter a with ogonek
+{N6110_Europe,0x15,0x01,0x06},//Latin capital letter c with acute
+{N6110_Europe,0x17,0x01,0x07},//Latin small letter c with acute
+{N6110_Europe,0x1D,0x01,0x18},//Latin capital letter e with ogonek
+{N6110_Europe,0x1E,0x01,0x19},//Latin small letter e with ogonek
+{N6110_Europe,0x83,0x00,0xD3},//Latin capital letter o with acute
+{N6110_Europe,0x8E,0x01,0x41},//Latin capital letter l with stroke
+{N6110_Europe,0x90,0x01,0x42},//Latin small letter l with stroke
+{N6110_Europe,0x92,0x01,0x43},//Latin capital letter n with acute
+{N6110_Europe,0x93,0x01,0x44},//Latin small letter n with acute
+{N6110_Europe,0x9A,0x00,0xF3},//Latin small letter o with acute
+{N6110_Europe,0xB2,0x20,0xAC},//euro
+{N6110_Europe,0xB5,0x01,0x5A},//Latin capital letter s with acute
+{N6110_Europe,0xB6,0x01,0x5B},//Latin small letter s with acute
+{N6110_Europe,0xE7,0x01,0x79},//Latin capital letter z with acute
+{N6110_Europe,0xEE,0x01,0x7A},//Latin small letter z with acute
+{N6110_Europe,0xF4,0x01,0x7C},//Latin small letter z with dot above
+{N6110_Europe,0xF0,0x01,0x7B},//Latin capital letter z with dot above
+{0,0,0,0}
+};
+
+static void N6110_EncodeUnicode(GSM_StateMachine *s, unsigned char *dest, const unsigned char *src, int len)
+{
+ int i_len = 0, o_len, i;
+ wchar_t wc;
+ GSM_Phone_N6110Data *Priv = &s->Phone.Data.Priv.N6110;
+ bool found;
+
+ for (o_len = 0; i_len < len; o_len++) {
+ found = false;
+ if (Priv->PhoneLanguage != N6110_Auto) {
+ i = 0;
+ while(1) {
+ if (N6110_Lang_Table[i].Lang == 0) break;
+ if (N6110_Lang_Table[i].Lang == Priv->PhoneLanguage &&
+ N6110_Lang_Table[i].Phone == src[i_len]) {
+ dest[o_len*2] = N6110_Lang_Table[i].Unicode1;
+ dest[(o_len*2)+1] = N6110_Lang_Table[i].Unicode2;
+ i_len++;
+ found = true;
+ break;
+ }
+ i++;
+ }
+ }
+ if (!found) {
+ i_len += EncodeWithUnicodeAlphabet(&src[i_len], &wc);
+ dest[o_len*2] = (wc >> 8) & 0xff;
+ dest[(o_len*2)+1] = wc & 0xff;
+ }
+ }
+ dest[o_len*2] = 0;
+ dest[(o_len*2)+1] = 0;
+}
+
+#ifndef ENABLE_LGPL
+
+/* This function provides Nokia authentication protocol.
+ * Nokia authentication protocol is used in the communication between Nokia
+ * mobile phones (e.g. Nokia 6110) and Nokia Cellular Data Suite software,
+ * commercially sold by Nokia Corp.
+ * The authentication scheme is based on the token send by the phone to the
+ * software. The software does it's magic (see the function
+ * N6110_GetNokiaAuthentication) and returns the result back to the phone.
+ * If the result is correct the phone responds with the message "Accessory
+ * connected!" displayed on the LCD. Otherwise it will display "Accessory not
+ * supported" and some functions will not be available for use (?).
+ * The specification of the protocol is not publicly available, no comment.
+ */
+static void N6110_GetNokiaAuthentication(unsigned char *Imei, unsigned char *MagicBytes, unsigned char *MagicResponse)
+{
+ int i, j, CRC=0;
+ unsigned char Temp[16]; /* This is our temporary working area. */
+
+ /* Here we put FAC (Final Assembly Code) and serial number into our area. */
+ Temp[0] = Imei[6]; Temp[1] = Imei[7];
+ Temp[2] = Imei[8]; Temp[3] = Imei[9];
+ Temp[4] = Imei[10]; Temp[5] = Imei[11];
+ Temp[6] = Imei[12]; Temp[7] = Imei[13];
+
+ /* And now the TAC (Type Approval Code). */
+ Temp[8] = Imei[2]; Temp[9] = Imei[3];
+ Temp[10] = Imei[4]; Temp[11] = Imei[5];
+
+ /* And now we pack magic bytes from the phone. */
+ Temp[12] = MagicBytes[0]; Temp[13] = MagicBytes[1];
+ Temp[14] = MagicBytes[2]; Temp[15] = MagicBytes[3];
+
+ for (i=0; i<=11; i++) if (Temp[i + 1]& 1) Temp[i]<<=1;
+ switch (Temp[15] & 0x03) {
+ case 1:
+ case 2: j = Temp[13] & 0x07;
+ for (i=0; i<=3; i++) Temp[i+j] ^= Temp[i+12];
+ break;
+ default: j = Temp[14] & 0x07;
+ for (i=0; i<=3; i++) Temp[i + j] |= Temp[i + 12];
+ }
+ for (i=0; i<=15; i++) CRC ^= Temp[i];
+ for (i=0; i<=15; i++) {
+ switch (Temp[15 - i] & 0x06) {
+ case 0: j = Temp[i] | CRC; break;
+ case 2:
+ case 4: j = Temp[i] ^ CRC; break;
+ case 6: j = Temp[i] & CRC; break;
+ }
+ if (j == CRC) j = 0x2c;
+ if (Temp[i] == 0) j = 0;
+ MagicResponse[i] = j;
+ }
+}
+
+static GSM_Error N6110_ReplyGetMagicBytes(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_N6110Data *Priv = &s->Phone.Data.Priv.N6110;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ sprintf(Data->IMEI, "%s", msg.Buffer+9);
+ sprintf(Data->HardwareCache, "%s", msg.Buffer+39);
+ sprintf(Data->ProductCodeCache, "%s", msg.Buffer+31);
+
+ smprintf(s, "Message: Mobile phone identification received:\n");
+ smprintf(s, "IMEI : %s\n", msg.Buffer+9);
+ smprintf(s, "Model : %s\n", msg.Buffer+25);
+ smprintf(s, "Production Code : %s\n", msg.Buffer+31);
+ smprintf(s, "HW : %s\n", msg.Buffer+39);
+ smprintf(s, "Firmware : %s\n", msg.Buffer+44);
+
+ /* These bytes are probably the source of the "Accessory not connected"
+ * messages on the phone when trying to emulate NCDS... I hope....
+ * UPDATE: of course, now we have the authentication algorithm.
+ */
+ smprintf(s, " Magic bytes : %02x %02x %02x %02x\n", msg.Buffer[50], msg.Buffer[51], msg.Buffer[52], msg.Buffer[53]);
+
+ Priv->MagicBytes[0]=msg.Buffer[50];
+ Priv->MagicBytes[1]=msg.Buffer[51];
+ Priv->MagicBytes[2]=msg.Buffer[52];
+ Priv->MagicBytes[3]=msg.Buffer[53];
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_MakeAuthentication(GSM_StateMachine *s)
+{
+ GSM_Phone_N6110Data *Priv = &s->Phone.Data.Priv.N6110;
+ GSM_Error error;
+ unsigned char connect4[] = {N6110_FRAME_HEADER, 0x10};
+ unsigned char magic_connect[] = {
+ N6110_FRAME_HEADER, 0x12,
+ /* The real magic goes here ... These bytes are filled in
+ * with the function N6110_GetNokiaAuthentication. */
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ /* NOKIA&GNOKII Accessory */
+ 'N', 'O', 'K', 'I', 'A', '&', 'N', 'O', 'K', 'I', 'A',
+ 'a', 'c', 'c', 'e', 's', 's', 'o', 'r', 'y',
+ 0x00, 0x00, 0x00, 0x00};
+
+ smprintf(s, "Getting magic bytes for authentication\n");
+ error=GSM_WaitFor (s, connect4, 4, 0x64, 4, ID_MakeAuthentication);
+ if (error!=ERR_NONE) return error;
+
+ N6110_GetNokiaAuthentication(s->Phone.Data.IMEI, Priv->MagicBytes, magic_connect+4);
+ smprintf(s, "Sending authentication bytes\n");
+ return s->Protocol.Functions->WriteMessage(s, magic_connect, 45, 0x64);
+}
+
+#endif
+
+static GSM_Error N6110_ShowStartInfo(GSM_StateMachine *s, bool enable)
+{
+#ifdef ENABLE_LGPL
+ return ERR_NONE;
+#else
+ GSM_Error error=ERR_NONE;
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_MAGICBYTES)) {
+ if (s->ConnectionType == GCT_FBUS2 ||
+ s->ConnectionType == GCT_FBUS2IRDA) {
+ error=N6110_MakeAuthentication(s);
+ }
+ }
+ return error;
+#endif
+}
+
+static GSM_Error N6110_Initialise (GSM_StateMachine *s)
+{
+#ifdef DEBUG
+ DCT3_SetIncomingCB(s,true);
+#endif
+ N6110_GetPhoneLanguage(s);
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_GetDateTime(GSM_StateMachine *s, GSM_DateTime *date_time)
+{
+ return DCT3_GetDateTime(s, date_time, 0x11);
+}
+
+static GSM_Error N6110_GetAlarm(GSM_StateMachine *s, GSM_Alarm *alarm)
+{
+ return DCT3_GetAlarm(s, alarm, 0x11);
+}
+
+static GSM_Error N6110_SetDateTime(GSM_StateMachine *s, GSM_DateTime *date_time)
+{
+ return DCT3_SetDateTime(s, date_time, 0x11);
+}
+
+static GSM_Error N6110_SetAlarm(GSM_StateMachine *s, GSM_Alarm *alarm)
+{
+ return DCT3_SetAlarm(s, alarm, 0x11);
+}
+
+static GSM_Error N6110_ReplyGetMemory(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ int count;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Phonebook entry received\n");
+ switch (msg.Buffer[3]) {
+ case 0x02:
+ Data->Memory->EntriesNum = 0;
+ count=5;
+ /* If name is not empty */
+ if (msg.Buffer[count]!=0x00) {
+ if (msg.Buffer[count]>GSM_PHONEBOOK_TEXT_LENGTH) {
+ smprintf(s, "Too long text\n");
+ return ERR_UNKNOWNRESPONSE;
+ }
+ Data->Memory->Entries[Data->Memory->EntriesNum].EntryType=PBK_Text_Name;
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOPBKUNICODE)) {
+ if (Data->Memory->MemoryType==MEM_DC ||
+ Data->Memory->MemoryType==MEM_RC ||
+ Data->Memory->MemoryType==MEM_MC ||
+ Data->Memory->MemoryType==MEM_ME) {
+ N6110_EncodeUnicode(s,Data->Memory->Entries[Data->Memory->EntriesNum].Text,
+ msg.Buffer+count+1,msg.Buffer[count]);
+ } else {
+ EncodeUnicode(Data->Memory->Entries[Data->Memory->EntriesNum].Text,
+ msg.Buffer+count+1,msg.Buffer[count]);
+ }
+ } else {
+ memcpy(Data->Memory->Entries[Data->Memory->EntriesNum].Text,
+ msg.Buffer+count+1,msg.Buffer[count]);
+ Data->Memory->Entries[Data->Memory->EntriesNum].Text[msg.Buffer[count]]=0x00;
+ Data->Memory->Entries[Data->Memory->EntriesNum].Text[msg.Buffer[count]+1]=0x00;
+ }
+ smprintf(s, "Name \"%s\"\n",
+ DecodeUnicodeString(Data->Memory->Entries[Data->Memory->EntriesNum].Text));
+ Data->Memory->EntriesNum++;
+ }
+ count=count+msg.Buffer[count]+1;
+
+ /* If number is empty */
+ if (msg.Buffer[count]==0x00) return ERR_EMPTY;
+
+ if (msg.Buffer[count]>GSM_PHONEBOOK_TEXT_LENGTH) {
+ smprintf(s, "Too long text\n");
+ return ERR_UNKNOWNRESPONSE;
+ }
+ Data->Memory->Entries[Data->Memory->EntriesNum].EntryType = PBK_Number_General;
+ Data->Memory->Entries[Data->Memory->EntriesNum].VoiceTag = 0;
+ Data->Memory->Entries[Data->Memory->EntriesNum].SMSList[0] = 0;
+ EncodeUnicode(Data->Memory->Entries[Data->Memory->EntriesNum].Text,
+ msg.Buffer+count+1,msg.Buffer[count]);
+ smprintf(s, "Number \"%s\"\n",
+ DecodeUnicodeString(Data->Memory->Entries[Data->Memory->EntriesNum].Text));
+ Data->Memory->EntriesNum++;
+ count=count+msg.Buffer[count]+1;
+
+ if (!IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOCALLER)) {
+ if (msg.Buffer[count]<5) {
+ Data->Memory->Entries[Data->Memory->EntriesNum].EntryType=PBK_Caller_Group;
+ smprintf(s, "Caller group \"%i\"\n",msg.Buffer[count]);
+ Data->Memory->Entries[Data->Memory->EntriesNum].Number=msg.Buffer[count]+1;
+ Data->Memory->EntriesNum++;
+ }
+ }
+ count++;
+
+ if (Data->Memory->MemoryType==MEM_DC ||
+ Data->Memory->MemoryType==MEM_RC ||
+ Data->Memory->MemoryType==MEM_MC) {
+ NOKIA_DecodeDateTime(s, msg.Buffer+count+1,&Data->Memory->Entries[Data->Memory->EntriesNum].Date);
+ Data->Memory->Entries[Data->Memory->EntriesNum].EntryType=PBK_Date;
+
+ /* These values are set, when date and time unavailable in phone.
+ * Values from 3310 - in other can be different */
+ if (Data->Memory->Entries[2].Date.Day !=20 ||
+ Data->Memory->Entries[2].Date.Month !=1 ||
+ Data->Memory->Entries[2].Date.Year !=2118||
+ Data->Memory->Entries[2].Date.Hour !=3 ||
+ Data->Memory->Entries[2].Date.Minute!=14 ||
+ Data->Memory->Entries[2].Date.Second!=7)
+ Data->Memory->EntriesNum++;
+ }
+
+ return ERR_NONE;
+ default:
+ switch (msg.Buffer[4]) {
+ case 0x6f:
+ smprintf(s, "Phone is OFF\n");
+ return ERR_PHONEOFF;
+ case 0x74:
+ /* TODO: check if not too high */
+ smprintf(s, "ERROR: Empty ????\n");
+ Data->Memory->EntriesNum = 0;
+ return ERR_EMPTY;
+ case 0x7d:
+ smprintf(s, "ERROR: Invalid memory type\n");
+ return ERR_NOTSUPPORTED;
+ case 0x8d:
+ smprintf(s, "ERROR: no PIN\n");
+ return ERR_SECURITYERROR;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_GetMemory (GSM_StateMachine *s, GSM_MemoryEntry *entry)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x01,
+ 0x00, /* memory type */
+ 0x00, /* location */
+ 0x00};
+
+ req[4] = NOKIA_GetMemoryType(s, entry->MemoryType,N6110_MEMORY_TYPES);
+ if (req[4]==0xff) return ERR_NOTSUPPORTED;
+
+ req[5] = entry->Location;
+ if (entry->MemoryType==MEM_DC || entry->MemoryType==MEM_RC || entry->MemoryType==MEM_MC) req[5]--;
+
+ s->Phone.Data.Memory=entry;
+ smprintf(s, "Getting phonebook entry\n");
+ return GSM_WaitFor (s, req, 7, 0x03, 4, ID_GetMemory);
+}
+
+static GSM_Error N6110_ReplyGetMemoryStatus(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Memory status received\n");
+ switch (msg.Buffer[3]) {
+ case 0x08:
+ smprintf(s, "Memory type: %i\n",msg.Buffer[4]);
+
+ smprintf(s, "Free : %i\n",msg.Buffer[5]);
+ Data->MemoryStatus->MemoryFree=msg.Buffer[5];
+
+ smprintf(s, "Used : %i\n",msg.Buffer[6]);
+ Data->MemoryStatus->MemoryUsed=msg.Buffer[6];
+
+ return ERR_NONE;
+ break;
+ case 0x09:
+ switch (msg.Buffer[4]) {
+ case 0x6f:
+ smprintf(s, "Phone is probably powered off.\n");
+ return ERR_TIMEOUT;
+ case 0x7d:
+ smprintf(s, "Memory type not supported by phone model.\n");
+ return ERR_NOTSUPPORTED;
+ case 0x8d:
+ smprintf(s, "Waiting for security code.\n");
+ return ERR_SECURITYERROR;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ }
+ default:
+ return ERR_UNKNOWNRESPONSE;
+ }
+}
+
+static GSM_Error N6110_GetMemoryStatus(GSM_StateMachine *s, GSM_MemoryStatus *Status)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x07,
+ 0x00}; /* memory type */
+
+ req[4] = NOKIA_GetMemoryType(s, Status->MemoryType,N6110_MEMORY_TYPES);
+ if (req[4]==0xff) return ERR_NOTSUPPORTED;
+
+ s->Phone.Data.MemoryStatus=Status;
+ smprintf(s, "Getting memory status\n");
+ return GSM_WaitFor (s, req, 5, 0x03, 4, ID_GetMemoryStatus);
+}
+
+static GSM_Error N6110_ReplyGetSMSStatus(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "SMS status received\n");
+ switch (msg.Buffer[3]) {
+ case 0x37:
+ smprintf(s, "SIM size : %i\n",msg.Buffer[7]);
+ smprintf(s, "Used in SIM : %i\n",msg.Buffer[10]);
+ smprintf(s, "Unread in SIM : %i\n",msg.Buffer[11]);
+ Data->SMSStatus->SIMUsed = msg.Buffer[10];
+ Data->SMSStatus->SIMUnRead = msg.Buffer[11];
+ Data->SMSStatus->SIMSize = msg.Buffer[7];
+ Data->SMSStatus->PhoneUsed = 0;
+ Data->SMSStatus->PhoneUnRead = 0;
+ Data->SMSStatus->PhoneSize = 0;
+ Data->SMSStatus->TemplatesUsed = 0;
+ return ERR_NONE;
+ case 0x38:
+ smprintf(s, "Error. No PIN ?\n");
+ return ERR_SECURITYERROR;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_ReplyGetSMSMessage(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "SMS Message received\n");
+ switch(msg.Buffer[3]) {
+ case 0x08:
+ Data->GetSMSMessage->Number = 1;
+ Data->GetSMSMessage->SMS[0].Name[0] = 0;
+ Data->GetSMSMessage->SMS[0].Name[1] = 0;
+ Data->GetSMSMessage->SMS[0].Memory = MEM_SM;
+ NOKIA_DecodeSMSState(s, msg.Buffer[4], &Data->GetSMSMessage->SMS[0]);
+ switch (msg.Buffer[7]) {
+ case 0x00: case 0x01: /* Report or SMS_Deliver */
+ Data->GetSMSMessage->SMS[0].Folder = 0x01;
+ Data->GetSMSMessage->SMS[0].InboxFolder = true;
+ break;
+ case 0x02: /* SMS_Submit */
+ Data->GetSMSMessage->SMS[0].Folder = 0x02;
+ Data->GetSMSMessage->SMS[0].InboxFolder = false;
+ break;
+ default:
+ return ERR_UNKNOWNRESPONSE;
+ }
+ DCT3_DecodeSMSFrame(s, &Data->GetSMSMessage->SMS[0],msg.Buffer+8);
+ return ERR_NONE;
+ case 0x09:
+ switch (msg.Buffer[4]) {
+ case 0x00:
+ smprintf(s, "Unknown. Probably phone too busy\n");
+ return ERR_UNKNOWN;
+ case 0x02:
+ smprintf(s, "Too high location ?\n");
+ return ERR_INVALIDLOCATION;
+ case 0x06:
+ smprintf(s, "Phone is OFF\n");
+ return ERR_PHONEOFF;
+ case 0x07:
+ smprintf(s, "Empty\n");
+ return ERR_EMPTY;
+ case 0x0c:
+ smprintf(s, "Access error. No PIN ?\n");
+ return ERR_SECURITYERROR;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_GetSMSMessage(GSM_StateMachine *s, GSM_MultiSMSMessage *sms)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x07, 0x02,
+ 0x00, /* Location */
+ 0x01, 0x64};
+
+ if (sms->SMS[0].Folder!=0x00) return ERR_NOTSUPPORTED;
+
+ req[5] = sms->SMS[0].Location;
+
+ s->Phone.Data.GetSMSMessage=sms;
+ smprintf(s, "Getting sms\n");
+ return GSM_WaitFor (s, req, 8, 0x02, 4, ID_GetSMSMessage);
+}
+
+static GSM_Error N6110_GetNextSMSMessage(GSM_StateMachine *s, GSM_MultiSMSMessage *sms, bool start)
+{
+ GSM_Phone_N6110Data *Priv = &s->Phone.Data.Priv.N6110;
+ GSM_Error error;
+
+ if (start) {
+ error=s->Phone.Functions->GetSMSStatus(s,&Priv->LastSMSStatus);
+ if (error!=ERR_NONE) return error;
+ Priv->LastSMSRead=0;
+ sms->SMS[0].Location=0;
+ }
+ while (true) {
+ sms->SMS[0].Location++;
+ if (Priv->LastSMSRead>=(Priv->LastSMSStatus.SIMUsed+Priv->LastSMSStatus.PhoneUsed+Priv->LastSMSStatus.TemplatesUsed)) return ERR_EMPTY;
+ error=s->Phone.Functions->GetSMS(s, sms);
+ if (error==ERR_NONE) {
+ Priv->LastSMSRead++;
+ break;
+ }
+ if (error != ERR_EMPTY) return error;
+ }
+ return error;
+}
+
+static GSM_Error N6110_ReplyGetStatus(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+#ifdef DEBUG
+ smprintf(s, "Phone status received :\n");
+ smprintf(s, "Mode : ");
+ switch (msg.Buffer[4]) {
+ case 0x01: smprintf(s, "registered within the network\n"); break;
+ case 0x02: smprintf(s, "call in progress\n"); break; /* ringing or already answered call */
+ case 0x03: smprintf(s, "waiting for security code\n"); break;
+ case 0x04: smprintf(s, "powered off\n"); break;
+ default : smprintf(s, "unknown\n");
+ }
+ smprintf(s, "Power source : ");
+ switch (msg.Buffer[7]) {
+ case 0x01: smprintf(s, "AC/DC\n"); break;
+ case 0x02: smprintf(s, "battery\n"); break;
+ default : smprintf(s, "unknown\n");
+ }
+ smprintf(s, "Battery Level : %d\n", msg.Buffer[8]);
+ smprintf(s, "Signal strength : %d\n", msg.Buffer[5]);
+#endif
+
+ switch (Data->RequestID) {
+ case ID_GetBatteryCharge:
+ Data->BatteryCharge->BatteryPercent = ((int)msg.Buffer[8])*25;
+ switch (msg.Buffer[7]) {
+ case 0x01: Data->BatteryCharge->ChargeState = GSM_BatteryConnected; break;
+ case 0x02: Data->BatteryCharge->ChargeState = GSM_BatteryPowered; break;
+ default : Data->BatteryCharge->ChargeState = 0;
+ }
+ return ERR_NONE;
+ case ID_GetSignalQuality:
+ Data->SignalQuality->SignalPercent = ((int)msg.Buffer[5])*25;
+ return ERR_NONE;
+ default:
+ return ERR_UNKNOWNRESPONSE;
+ }
+}
+
+static GSM_Error N6110_GetStatus(GSM_StateMachine *s, int ID)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x01};
+
+ return GSM_WaitFor (s, req, 4, 0x04, 4, ID);
+}
+
+static GSM_Error N6110_GetSignalQuality(GSM_StateMachine *s, GSM_SignalQuality *sig)
+{
+ char value[100];
+ GSM_Error error;
+
+ sig->BitErrorRate = -1;
+ sig->SignalStrength = -1; /* TODO for netmon */
+
+ smprintf(s, "Getting network level\n");
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_POWER_BATT)) {
+ error = DCT3_Netmonitor(s, 1, value);
+ if (error!=ERR_NONE) return error;
+ sig->SignalPercent = 100;
+ if (value[4]!='-') {
+ if (value[5]=='9' && value[6]>'4') sig->SignalPercent = 25;
+ if (value[5]=='9' && value[6]<'5') sig->SignalPercent = 50;
+ if (value[5]=='8' && value[6]>'4') sig->SignalPercent = 75;
+ } else sig->SignalPercent = 0;
+ return ERR_NONE;
+ } else {
+ s->Phone.Data.SignalQuality = sig;
+ return N6110_GetStatus(s, ID_GetSignalQuality);
+ }
+}
+
+static GSM_Error N6110_GetBatteryCharge(GSM_StateMachine *s, GSM_BatteryCharge *bat)
+{
+ char value[100];
+ GSM_Error error;
+
+ smprintf(s, "Getting battery level\n");
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_POWER_BATT)) {
+ error = DCT3_Netmonitor(s, 23, value);
+ if (error!=ERR_NONE) return error;
+ bat->BatteryPercent = 100;
+ bat->ChargeState = 0;
+ if (value[29]=='7') bat->BatteryPercent = 75;
+ if (value[29]=='5') bat->BatteryPercent = 50;
+ if (value[29]=='2') bat->BatteryPercent = 25;
+ return ERR_NONE;
+ } else {
+ s->Phone.Data.BatteryCharge = bat;
+ return N6110_GetStatus(s, ID_GetBatteryCharge);
+ }
+}
+
+static GSM_Error N6110_ReplySaveSMSMessage(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "SMS message saving status\n");
+ switch (msg.Buffer[3]) {
+ case 0x05:
+ smprintf(s, "Saved at location %i\n",msg.Buffer[5]);
+ Data->SaveSMSMessage->Location=msg.Buffer[5];
+ return ERR_NONE;
+ case 0x06:
+ switch (msg.Buffer[4]) {
+ case 0x02:
+ smprintf(s, "All locations busy\n");
+ return ERR_FULL;
+ case 0x03:
+ smprintf(s, "Too high ?\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_PrivSetSMSMessage(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ int length;
+ GSM_Error error;
+ unsigned char req[256] = {N6110_FRAME_HEADER, 0x04,
+ 0x00, /* SMS status */
+ 0x02,
+ 0x00, /* SMS location */
+ 0x02}; /* SMS type */
+
+ req[6] = sms->Location;
+ if (sms->Folder==1) { /* Inbox */
+ req[4] = 1; /* SMS status - GSM_Read */
+ req[7] = 0x00; /* SMS type */
+ sms->PDU = SMS_Deliver;
+ error=PHONE_EncodeSMSFrame(s,sms,req+8,PHONE_SMSDeliver,&length,true);
+ } else { /* Outbox */
+ req[4] = 5; /* SMS status - GSM_Sent */
+ req[7] = 0x02; /* SMS type */
+ sms->PDU = SMS_Submit;
+ error=PHONE_EncodeSMSFrame(s,sms,req+8,PHONE_SMSSubmit,&length,true);
+ }
+ if (error != ERR_NONE) return error;
+
+ /* SMS State - GSM_Read -> GSM_Unread and GSM_Sent -> GSM_UnSent */
+ if (sms->State == SMS_UnSent || sms->State == SMS_UnRead) req[4] |= 0x02;
+
+ s->Phone.Data.SaveSMSMessage=sms;
+ smprintf(s, "Saving sms\n");
+ return GSM_WaitFor (s, req, 8+length, 0x14, 4, ID_SaveSMSMessage);
+}
+
+static GSM_Error N6110_SetSMS(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ if (sms->Location == 0) return ERR_INVALIDLOCATION;
+ return N6110_PrivSetSMSMessage(s, sms);
+}
+
+static GSM_Error N6110_AddSMS(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ sms->Location = 0;
+ return N6110_PrivSetSMSMessage(s, sms);
+}
+
+static GSM_Error N6110_ReplySetRingtone(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ switch (msg.Buffer[3]) {
+ case 0x37:
+ smprintf(s, "Ringtone set OK\n");
+ return ERR_NONE;
+ break;
+ case 0x38:
+ smprintf(s, "Error setting ringtone\n");
+ switch (msg.Buffer[4]) {
+ case 0x7d:
+ smprintf(s, "Too high location ?\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_ReplySetBinRingtone(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ switch (msg.Buffer[4]) {
+ case 0x00:
+ smprintf(s, "Set at location %i\n",msg.Buffer[3]+1);
+ return ERR_NONE;
+ default:
+ smprintf(s, "Invalid location. Too high ?\n");
+ return ERR_INVALIDLOCATION;
+ }
+}
+
+static GSM_Error N6110_SetRingtone(GSM_StateMachine *s, GSM_Ringtone *Ringtone, int *maxlength)
+{
+ GSM_NetworkInfo NetInfo;
+ GSM_Error error;
+ int size=200,current=8;
+ GSM_UDHHeader UDHHeader;
+ unsigned char req[1000] = {N6110_FRAME_HEADER, 0x36,
+ 0x00, /* Location */
+ 0x00,0x78};
+ unsigned char reqBin[1000] = {0x00,0x01,0xa0,0x00,0x00,0x0c,0x01,0x2c};
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NORING)) return ERR_NOTSUPPORTED;
+ if (Ringtone->Location == 0) return ERR_INVALIDLOCATION;
+
+ switch (Ringtone->Format) {
+ case RING_NOTETONE:
+ if (Ringtone->Location==255) {
+ /* Only 6110, 6130 and 6150 support it */
+ if (strcmp(s->Phone.Data.Model,"NSE-3") == 0 || strcmp(s->Phone.Data.Model,"NSK-3") == 0 ||
+ strcmp(s->Phone.Data.Model,"NSM-1") == 0) {
+ req[0] = 0x0c;
+ req[1] = 0x01;
+ UDHHeader.Type = UDH_NokiaRingtone;
+ GSM_EncodeUDHHeader(&UDHHeader);
+ /* We copy UDH now */
+ memcpy(req+2,UDHHeader.Text,UDHHeader.Length);
+ *maxlength=GSM_EncodeNokiaRTTLRingtone(*Ringtone, req+2+UDHHeader.Length, &size);
+ error = s->Protocol.Functions->WriteMessage(s, req, 2+UDHHeader.Length+size, 0x12);
+ if (error!=ERR_NONE) return error;
+ my_sleep(1000);
+ /* We have to make something (not important, what) now */
+ /* no answer from phone*/
+ return DCT3_GetNetworkInfo(s,&NetInfo);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+ *maxlength=GSM_EncodeNokiaRTTLRingtone(*Ringtone, req+7, &size);
+ req[4] = Ringtone->Location - 1;
+ smprintf(s, "Setting ringtone\n");
+ return GSM_WaitFor (s, req, 7 + size, 0x05, 4, ID_SetRingtone);
+ case RING_NOKIABINARY:
+ error=DCT3_EnableSecurity (s, 0x01);
+ if (error!=ERR_NONE) return error;
+ memcpy(reqBin+current,DecodeUnicodeString(Ringtone->Name),UnicodeLength(Ringtone->Name));
+ current += UnicodeLength(Ringtone->Name);
+ reqBin[current++] = 0x00;
+ reqBin[current++] = 0x00;
+ reqBin[current++] = 0x00;/*xxx*/
+ memcpy(reqBin+current,Ringtone->NokiaBinary.Frame,Ringtone->NokiaBinary.Length);
+ current=current+Ringtone->NokiaBinary.Length;
+ reqBin[3]=Ringtone->Location-1;
+ if (!strcmp(s->Phone.Data.ModelInfo->model,"3210")) reqBin[5]=0x10;
+ smprintf(s, "Setting binary ringtone\n");
+ return GSM_WaitFor (s, reqBin, current, 0x40, 4, ID_SetRingtone);
+ case RING_MIDI:
+ return ERR_NOTSUPPORTED;
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6110_ReplyGetOpLogo(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ int count=5;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Operator logo received\n");
+ NOKIA_DecodeNetworkCode(msg.Buffer+count,Data->Bitmap->NetworkCode);
+ count = count + 3;
+ smprintf(s, "Network code : %s\n", Data->Bitmap->NetworkCode);
+ smprintf(s, "Network name for Gammu : %s ",
+ DecodeUnicodeString(GSM_GetNetworkName(Data->Bitmap->NetworkCode)));
+ smprintf(s, "(%s)\n",DecodeUnicodeString(GSM_GetCountryName(Data->Bitmap->NetworkCode)));
+
+ count = count + 3; /* We ignore size */
+ Data->Bitmap->BitmapWidth = msg.Buffer[count++];
+ Data->Bitmap->BitmapHeight = msg.Buffer[count++];
+ count++;
+ PHONE_DecodeBitmap(GSM_NokiaOperatorLogo,msg.Buffer+count,Data->Bitmap);
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_ReplyGetStartup(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ int i, count = 5;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Startup logo & notes received\n");
+ for (i=0;i<msg.Buffer[4];i++) {
+ switch (msg.Buffer[count++]) {
+ case 0x01:
+ smprintf(s, "Startup logo\n");
+ if (Data->Bitmap->Type == GSM_StartupLogo) {
+ Data->Bitmap->BitmapHeight = msg.Buffer[count++];
+ Data->Bitmap->BitmapWidth = msg.Buffer[count++];
+ PHONE_DecodeBitmap(GSM_NokiaStartupLogo, msg.Buffer + count, Data->Bitmap);
+ } else {
+ count = count + 2;
+ }
+ count = count + PHONE_GetBitmapSize(GSM_NokiaStartupLogo,0,0);
+ break;
+ case 0x02:
+ smprintf(s, "Welcome note\n");
+ if (Data->Bitmap->Type == GSM_WelcomeNote_Text) {
+ EncodeUnicode(Data->Bitmap->Text,msg.Buffer+count, msg.Buffer[count]);
+ smprintf(s, "Text is \"%s\"\n",Data->Bitmap->Text);
+ }
+ count = count + msg.Buffer[count] + 1;
+ break;
+ case 0x03:
+ smprintf(s, "Dealer welcome note\n");
+ if (Data->Bitmap->Type == GSM_DealerNote_Text) {
+ EncodeUnicode(Data->Bitmap->Text,msg.Buffer+count, msg.Buffer[count]);
+ smprintf(s, "Text is \"%s\"\n",Data->Bitmap->Text);
+ }
+ count = count + msg.Buffer[count] + 1;
+ break;
+ default:
+ smprintf(s, "Unknown block\n");
+ return ERR_UNKNOWNRESPONSE;
+ break;
+ }
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_ReplyGetCallerLogo(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ int count;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg.Buffer[3]) {
+ case 0x11:
+ smprintf(s, "Caller group info received\n");
+ EncodeUnicode(Data->Bitmap->Text,msg.Buffer+6,msg.Buffer[5]);
+ smprintf(s, "Name : \"%s\"\n",DecodeUnicodeString(Data->Bitmap->Text));
+ Data->Bitmap->DefaultName = false;
+ if (msg.Buffer[5] == 0x00) Data->Bitmap->DefaultName = true;
+ count = msg.Buffer[5] + 6;
+ Data->Bitmap->RingtoneID = msg.Buffer[count++];
+ Data->Bitmap->DefaultRingtone = false;
+ Data->Bitmap->FileSystemRingtone = false;
+ if (Data->Bitmap->RingtoneID == 16) Data->Bitmap->DefaultRingtone = true;
+ smprintf(s, "Ringtone ID: %02x\n",Data->Bitmap->RingtoneID);
+ Data->Bitmap->BitmapEnabled=(msg.Buffer[count++]==1);
+#ifdef DEBUG
+ smprintf(s, "Caller group logo ");
+ if (Data->Bitmap->BitmapEnabled) {
+ smprintf(s, "enabled\n");
+ } else {
+ smprintf(s, "disabled\n");
+ }
+#endif
+ count = count + 3; /* We ignore size */
+ Data->Bitmap->BitmapWidth = msg.Buffer[count++];
+ Data->Bitmap->BitmapHeight = msg.Buffer[count++];
+ count++;
+ PHONE_DecodeBitmap(GSM_NokiaCallerLogo,msg.Buffer+count,Data->Bitmap);
+ Data->Bitmap->DefaultBitmap = false;
+ return ERR_NONE;
+ case 0x12:
+ smprintf(s, "Error getting caller group info\n");
+ return ERR_INVALIDLOCATION;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_ReplyGetSetPicture(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ int count = 5, i;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg.Buffer[3]) {
+ case 0x02:
+ smprintf(s, "Picture Image received\n");
+ if (msg.Buffer[count]!=0) {
+ GSM_UnpackSemiOctetNumber(Data->Bitmap->Sender, msg.Buffer + 5, true);
+ /* Convert number of semioctets to number of chars */
+ i = msg.Buffer[5];
+ if (i % 2) i++;
+ i=i / 2 + 1;
+ count = count + i + 1;
+ } else {
+ Data->Bitmap->Sender[0] = 0x00;
+ Data->Bitmap->Sender[1] = 0x00;
+ count+=2;
+ }
+ smprintf(s, "Sender : \"%s\"\n",DecodeUnicodeString(Data->Bitmap->Sender));
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOPICTUREUNI) ||
+ (!strcmp(Data->Model,"NHM-5") && Data->VerNum < 5.79)) {
+ count++;
+ EncodeUnicode(Data->Bitmap->Text,msg.Buffer+count+1,msg.Buffer[count]);
+ count += UnicodeLength(Data->Bitmap->Text) + 1;
+ } else {
+ if (!strcmp(Data->Model,"NHM-5")) {
+ i = msg.Buffer[count] * 256 + msg.Buffer[count+1];
+ } else {
+ /* 3410 4.26 */
+ i = msg.Buffer[count] * 256 + msg.Buffer[count+1] - 2;
+ count += 2;
+ }
+ memcpy(Data->Bitmap->Text,msg.Buffer+count+2,i);
+ Data->Bitmap->Text[i] = 0;
+ Data->Bitmap->Text[i+1] = 0;
+ count += i + 2;
+ }
+ smprintf(s, "Text : \"%s\"\n",DecodeUnicodeString(Data->Bitmap->Text));
+ Data->Bitmap->BitmapWidth = msg.Buffer[count++];
+ Data->Bitmap->BitmapHeight = msg.Buffer[count++];
+ PHONE_DecodeBitmap(GSM_NokiaPictureImage, msg.Buffer + count + 2, Data->Bitmap);
+#ifdef DEBUG
+ if (di.dl == DL_TEXTALL || di.dl == DL_TEXTALLDATE) GSM_PrintBitmap(di.df,Data->Bitmap);
+#endif
+ return ERR_NONE;
+ break;
+ case 0x04:
+ smprintf(s, "Picture Image set OK\n");
+ return ERR_NONE;
+ case 0x05:
+ smprintf(s, "Can't set Picture Image - invalid location ?\n");
+ return ERR_INVALIDLOCATION;
+ break;
+ case 0x06:
+ smprintf(s, "Can't get Picture Image - invalid location ?\n");
+ return ERR_INVALIDLOCATION;
+ break;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_GetBitmap(GSM_StateMachine *s, GSM_Bitmap *Bitmap)
+{
+ GSM_Error error;
+ unsigned char req[10] = {N6110_FRAME_HEADER};
+
+ s->Phone.Data.Bitmap=Bitmap;
+ switch (Bitmap->Type) {
+ case GSM_StartupLogo:
+ case GSM_WelcomeNote_Text:
+ case GSM_DealerNote_Text:
+ if (Bitmap->Type == GSM_StartupLogo && IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOSTARTUP)) return ERR_NOTSUPPORTED;
+ req[3] = 0x16;
+ return GSM_WaitFor (s, req, 4, 0x05, 4, ID_GetBitmap);
+ case GSM_CallerGroupLogo:
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOCALLER)) return ERR_NOTSUPPORTED;
+ req[3] = 0x10;
+ req[4] = Bitmap->Location - 1;
+ error = GSM_WaitFor (s, req, 5, 0x03, 4, ID_GetBitmap);
+ if (error==ERR_NONE) NOKIA_GetDefaultCallerGroupName(s,Bitmap);
+ return error;
+ case GSM_OperatorLogo:
+ req[3] = 0x33;
+ req[4] = 0x01;
+ return GSM_WaitFor (s, req, 5, 0x05, 4, ID_GetBitmap);
+ case GSM_PictureImage:
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOPICTURE)) return ERR_NOTSUPPORTED;
+ req[3] = 0x01;
+ req[4] = Bitmap->Location - 1;
+ return GSM_WaitFor (s, req, 5, 0x47, 4, ID_GetBitmap);
+ default:
+ break;
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6110_ReplySetProfileFeature(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ switch (msg.Buffer[3]) {
+ case 0x11:
+ smprintf(s, "Feature of profile set\n");
+ return ERR_NONE;
+ case 0x12:
+ smprintf(s, "Error setting profile feature\n");
+ return ERR_NOTSUPPORTED;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_SetProfileFeature(GSM_StateMachine *s, unsigned char profile, unsigned char feature, unsigned char value)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x10, 0x01,
+ 0x00, /* Profile */
+ 0x00, /* Feature */
+ 0x00}; /* Value */
+
+ req[5]=profile;
+ req[6]=feature;
+ req[7]=value;
+ smprintf(s, "Setting profile feature\n");
+ return GSM_WaitFor (s, req, 8, 0x05, 4, ID_SetProfile);
+}
+
+static GSM_Error N6110_ReplySetStartup(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Startup logo set OK\n");
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_ReplySetCallerLogo(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ switch (msg.Buffer[3]) {
+ case 0x14:
+ smprintf(s, "Caller group set OK\n");
+ return ERR_NONE;
+ case 0x15:
+ smprintf(s, "Error setting caller group\n");
+ return ERR_INVALIDLOCATION;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_SetBitmap(GSM_StateMachine *s, GSM_Bitmap *Bitmap)
+{
+ unsigned char reqPreview[1000] = {0x0c,0x01};
+ unsigned char req[600] = {N6110_FRAME_HEADER};
+ GSM_UDH UDHType = UDH_NokiaOperatorLogo;
+ int count = 0, textlen, Width, Height;
+ GSM_UDHHeader UDHHeader;
+ GSM_NetworkInfo NetInfo;
+ GSM_Error error;
+
+ switch (Bitmap->Type) {
+ case GSM_CallerGroupLogo:
+ case GSM_OperatorLogo:
+ if (Bitmap->Location == 255) {
+ /* Only 6110, 6130 and 6150 support it */
+ if (strcmp(s->Phone.Data.Model,"NSE-3") == 0 || strcmp(s->Phone.Data.Model,"NSK-3") == 0 ||
+ strcmp(s->Phone.Data.Model,"NSM-1") == 0) {
+ if (Bitmap->Type==GSM_CallerGroupLogo) UDHType = UDH_NokiaCallerLogo;
+ UDHHeader.Type = UDHType;
+ GSM_EncodeUDHHeader(&UDHHeader);
+ /* We copy UDH now */
+ memcpy(reqPreview+2,UDHHeader.Text,UDHHeader.Length);
+ count = count + UDHHeader.Length;
+ if (Bitmap->Type == GSM_OperatorLogo) {
+ NOKIA_EncodeNetworkCode(reqPreview+count,Bitmap->NetworkCode);
+ count = count + 3;
+ } else {
+ if (Bitmap->DefaultBitmap) {
+ Bitmap->BitmapWidth = 72;
+ Bitmap->BitmapHeight = 14;
+ GSM_ClearBitmap(Bitmap);
+ }
+ }
+ NOKIA_CopyBitmap(GSM_NokiaOperatorLogo,Bitmap,reqPreview, &count);
+ reqPreview[count]=0x00;
+ error = s->Protocol.Functions->WriteMessage(s, reqPreview, count + 1, 0x12);
+ if (error!=ERR_NONE) return error;
+ my_sleep(1000);
+ /* We have to make something (not important, what) now */
+ /* no answer from phone*/
+ return DCT3_GetNetworkInfo(s,&NetInfo);
+ } else {
+ smprintf(s, "%s\n",s->Phone.Data.Model);
+ return ERR_NOTSUPPORTED;
+ }
+ }
+ break;
+ default:
+ break;
+ }
+
+ count = 3;
+
+ switch (Bitmap->Type) {
+ case GSM_StartupLogo:
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOSTARTUP)) return ERR_NOTSUPPORTED;
+ if (Bitmap->Location != 1) {
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOSTARTANI)) return ERR_NOTSUPPORTED;
+ }
+ if (!IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOSTARTANI)) {
+ if (!strcmp(s->Phone.Data.ModelInfo->model,"3210")) {
+ error = N6110_SetProfileFeature(s,0,0x2e,((unsigned char)(Bitmap->Location-1)));
+ } else {
+ error = N6110_SetProfileFeature(s,0,0x29,((unsigned char)(Bitmap->Location-1)));
+ }
+ if (error == ERR_NOTSUPPORTED) error = ERR_SECURITYERROR;
+ if (error != ERR_NONE) return error;
+ if (Bitmap->Location != 1) return ERR_NONE;
+ }
+ req[count++] = 0x18;
+ req[count++] = 0x01; /* One block */
+ req[count++] = 0x01;
+ PHONE_GetBitmapWidthHeight(GSM_NokiaStartupLogo, &Width, &Height);
+ req[count++] = Height;
+ req[count++] = Width;
+ PHONE_EncodeBitmap(GSM_NokiaStartupLogo, req + count, Bitmap);
+ count = count + PHONE_GetBitmapSize(GSM_NokiaStartupLogo,0,0);
+ return GSM_WaitFor (s, req, count, 0x05, 4, ID_SetBitmap);
+ case GSM_WelcomeNote_Text:
+ case GSM_DealerNote_Text:
+ req[count++] = 0x18;
+ req[count++] = 0x01; /* One block */
+ if (Bitmap->Type == GSM_WelcomeNote_Text) {
+ req[count++] = 0x02;
+ } else {
+ req[count++] = 0x03;
+ }
+ textlen = UnicodeLength(Bitmap->Text);
+ req[count++] = textlen;
+ memcpy(req + count,DecodeUnicodeString(Bitmap->Text),textlen);
+ count += textlen;
+ return GSM_WaitFor (s, req, count, 0x05, 4, ID_SetBitmap);
+ case GSM_CallerGroupLogo:
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOCALLER)) return ERR_NOTSUPPORTED;
+ req[count++] = 0x13;
+ req[count++] = Bitmap->Location - 1;
+ if (Bitmap->DefaultName) {
+ req[count++] = 0;
+ } else {
+ textlen = UnicodeLength(Bitmap->Text);
+ req[count++] = textlen;
+ memcpy(req+count,DecodeUnicodeString(Bitmap->Text),textlen);
+ count += textlen;
+ }
+ if (Bitmap->DefaultRingtone) {
+ req[count++] = 16;
+ } else {
+ req[count++] = Bitmap->RingtoneID;
+ }
+ /* Value here is number of phone menu connected
+ * with caller logo in Nokia 61x0: 0x00 = Off, 0x01 = On,
+ * 0x02 = View Graphics, 0x03 = Send Graphics,
+ * 0x04 = Send via IR. For higher menu option connected with
+ * caller logo is not displayed
+ */
+ if (Bitmap->DefaultBitmap) {
+ Bitmap->BitmapWidth = 72;
+ Bitmap->BitmapHeight = 14;
+ GSM_ClearBitmap(Bitmap);
+ req[count++] = 0;
+ } else {
+ if (Bitmap->BitmapEnabled) req[count++] = 0x01; else req[count++] = 0x00;
+ }
+ req[count++] = (PHONE_GetBitmapSize(GSM_NokiaCallerLogo,0,0) + 4) / 256;
+ req[count++] = (PHONE_GetBitmapSize(GSM_NokiaCallerLogo,0,0) + 4) % 256;
+ NOKIA_CopyBitmap(GSM_NokiaCallerLogo, Bitmap, req, &count);
+ return GSM_WaitFor (s, req, count, 0x03, 4, ID_SetBitmap);
+ case GSM_OperatorLogo:
+ req[count++] = 0x30;
+ req[count++] = 0x01;
+ NOKIA_EncodeNetworkCode(req+count, Bitmap->NetworkCode);
+ count = count + 3;
+ req[count++] = (PHONE_GetBitmapSize(GSM_NokiaOperatorLogo,0,0) + 4) / 256;
+ req[count++] = (PHONE_GetBitmapSize(GSM_NokiaOperatorLogo,0,0) + 4) % 256;
+ NOKIA_CopyBitmap(GSM_NokiaOperatorLogo, Bitmap, req, &count);
+ return GSM_WaitFor (s, req, count, 0x05, 4, ID_SetBitmap);
+ case GSM_PictureImage:
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NOPICTURE)) return ERR_NOTSUPPORTED;
+ req[count++] = 0x03;
+ req[count++] = Bitmap->Location - 1;
+ if (Bitmap->Sender[0]!=0 || Bitmap->Sender[1]!=0) {
+ req[count]=GSM_PackSemiOctetNumber(Bitmap->Sender, req+count+1,true);
+ /* Convert number of semioctets to number of chars and add count */
+ textlen = req[count];
+ if (textlen % 2) textlen++;
+ count += textlen / 2 + 1;
+ count++;
+ } else {
+ req[count++] = 0x00;
+ req[count++] = 0x00;
+ }
+ req[count++] = 0x00;
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOPICTUREUNI) ||
+ (!strcmp(s->Phone.Data.Model,"NHM-5") && s->Phone.Data.VerNum < 5.79)) {
+ textlen = UnicodeLength(Bitmap->Text);
+ req[count++] = textlen;
+ memcpy(req+count,DecodeUnicodeString(Bitmap->Text),textlen);
+ count += textlen;
+ } else {
+ textlen = UnicodeLength(Bitmap->Text)*2;
+ if (!strcmp(s->Phone.Data.Model,"NHM-5")) {
+ req[count++] = textlen;
+ } else {
+ /* 3410 4.26 */
+ req[count++] = textlen+2;
+ req[count++] = 0x00;
+ req[count++] = 0x1e;
+ }
+ memcpy(req+count,Bitmap->Text,textlen);
+ count += textlen;
+ }
+ NOKIA_CopyBitmap(GSM_NokiaPictureImage, Bitmap, req, &count);
+ return GSM_WaitFor (s, req, count, 0x47, 4, ID_SetBitmap);
+ default:
+ break;
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6110_ReplyCallInfo(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ int tmp, count;
+ GSM_Call call;
+
+ call.CallIDAvailable = true;
+ call.Status = 0;
+ smprintf(s, "Call info, ");
+ switch (msg.Buffer[3]) {
+ case 0x02:
+ smprintf(s, "Call established, waiting for answer\n");
+ call.Status = GSM_CALL_CallEstablished;
+ break;
+ case 0x03:
+ smprintf(s, "Call started\n");
+ /* no phone number in frame */
+ call.Status = GSM_CALL_CallStart;
+ break;
+ case 0x04:
+ smprintf(s, "Remote end hang up\n");
+ smprintf(s, "CC : %i\n",msg.Buffer[6]);
+ call.Status = GSM_CALL_CallRemoteEnd;
+ call.StatusCode = msg.Buffer[6];
+ break;
+ case 0x05:
+ smprintf(s, "Incoming call\n");
+ smprintf(s, "Number : \"");
+ count=msg.Buffer[6];
+ for (tmp=0; tmp <count; tmp++) smprintf(s, "%c", msg.Buffer[7+tmp]);
+ smprintf(s, "\"\nName : \"");
+ for (tmp=0; tmp<msg.Buffer[7+count]; tmp++) smprintf(s, "%c", msg.Buffer[8+count+tmp]);
+ smprintf(s, "\"\n");
+
+ call.Status = GSM_CALL_IncomingCall;
+ EncodeUnicode(call.PhoneNumber, msg.Buffer+7, msg.Buffer[6]);
+ break;
+ case 0x07:
+ smprintf(s, "Call answer initiated\n");
+ break;
+ case 0x09:
+ smprintf(s, "Call released\n");
+ call.Status = GSM_CALL_CallLocalEnd;
+ break;
+ case 0x0a:
+ smprintf(s, "Call is being released\n");
+ break;
+ case 0x23:
+ smprintf(s, "Call held\n");
+ call.Status = GSM_CALL_CallHeld;
+ break;
+ case 0x25:
+ smprintf(s, "Call resumed\n");
+ call.Status = GSM_CALL_CallResumed;
+ break;
+ case 0x27:
+ smprintf(s, "Call switched\n");
+ /* incorrect call id in frame - 6150 5.22 */
+ call.CallIDAvailable = false;
+ call.Status = GSM_CALL_CallSwitched;
+ break;
+ case 0x29:
+ smprintf(s, "Joining call to the conference (conference)\n");
+ break;
+ case 0x2A:
+ smprintf(s, "Removing call from the conference (split)\n");
+ break;
+ }
+ if (call.CallIDAvailable) smprintf(s, "Call ID : %d\n",msg.Buffer[4]);
+ if (Data->EnableIncomingCall && s->User.IncomingCall!=NULL && call.Status != 0) {
+ if (call.CallIDAvailable) call.CallID = msg.Buffer[4];
+ s->User.IncomingCall(s->CurrentConfig->Device, call);
+ }
+ if (s->Phone.Data.RequestID == ID_CancelCall) {
+ if (msg.Buffer[3] == 0x09) {
+ if (s->Phone.Data.CallID == msg.Buffer[4]) return ERR_NONE;
+ /* when we canceled call and see frame about other
+ * call releasing, we don't give ERR_NONE for "our"
+ * call release command
+ */
+ return ERR_NEEDANOTHERANSWER;
+ }
+ }
+ if (s->Phone.Data.RequestID == ID_AnswerCall) {
+ if (msg.Buffer[3] == 0x07) {
+ if (s->Phone.Data.CallID == msg.Buffer[4]) return ERR_NONE;
+ return ERR_NEEDANOTHERANSWER;
+ }
+ }
+ if (s->Phone.Data.RequestID == ID_UnholdCall) {
+ if (msg.Buffer[3] == 0x25) {
+ if (s->Phone.Data.CallID == msg.Buffer[4]) return ERR_NONE;
+ return ERR_NEEDANOTHERANSWER;
+ }
+ }
+ if (s->Phone.Data.RequestID == ID_HoldCall) {
+ if (msg.Buffer[3] == 0x23) {
+ if (s->Phone.Data.CallID == msg.Buffer[4]) return ERR_NONE;
+ return ERR_NEEDANOTHERANSWER;
+ }
+ }
+ if (s->Phone.Data.RequestID == ID_ConferenceCall) {
+ if (msg.Buffer[3] == 0x29) {
+ if (s->Phone.Data.CallID == msg.Buffer[4]) return ERR_NONE;
+ return ERR_NEEDANOTHERANSWER;
+ }
+ }
+ if (s->Phone.Data.RequestID == ID_SplitCall) {
+ if (msg.Buffer[3] == 0x2B) {
+ if (s->Phone.Data.CallID == msg.Buffer[4]) return ERR_NONE;
+ return ERR_NEEDANOTHERANSWER;
+ }
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_DeleteSMSMessage(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x0a, 0x02,
+ 0x00}; /* Location */
+
+ if (sms->Folder!=0x00) return ERR_NOTSUPPORTED;
+
+ req[5]=sms->Location;
+
+ smprintf(s, "Deleting sms\n");
+ return GSM_WaitFor (s, req, 6, 0x14, 4, ID_DeleteSMSMessage);
+}
+
+static GSM_Error N6110_ReplySetMemory(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Reply for writing memory\n");
+ switch (msg.Buffer[3]) {
+ case 0x05:
+ smprintf(s, "Done OK\n");
+ return ERR_NONE;
+ case 0x06:
+ smprintf(s, "Error\n");
+ switch (msg.Buffer[4]) {
+ case 0x7d:
+ smprintf(s, "Too high location ?\n");
+ return ERR_INVALIDLOCATION;
+ case 0x90:
+ smprintf(s, "Too long name...or other error\n");
+ return ERR_NOTSUPPORTED;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_SetMemory(GSM_StateMachine *s, GSM_MemoryEntry *entry)
+{
+ int current, Group, Name, Number;
+ unsigned char req[128] = {N6110_FRAME_HEADER, 0x04,
+ 0x00, /* memory type */
+ 0x00}; /* location */
+
+ if (entry->Location == 0) return ERR_NOTSUPPORTED;
+
+ GSM_PhonebookFindDefaultNameNumberGroup(entry, &Name, &Number, &Group);
+
+ req[4] = NOKIA_GetMemoryType(s, entry->MemoryType,N6110_MEMORY_TYPES);
+ req[5] = entry->Location;
+
+ current = 7;
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOPBKUNICODE)) {
+ if (Name != -1) {
+ req[6] = UnicodeLength(entry->Entries[Name].Text);
+ memcpy(req+current,DecodeUnicodeString(entry->Entries[Name].Text),UnicodeLength(entry->Entries[Name].Text));
+ current += UnicodeLength(entry->Entries[Name].Text);
+ } else req[6] = 0;
+ } else {
+ if (Name != -1) {
+ req[6] = UnicodeLength(entry->Entries[Name].Text)*2+2;
+ memcpy(req+current,entry->Entries[Name].Text,UnicodeLength(entry->Entries[Name].Text)*2);
+ current += UnicodeLength(entry->Entries[Name].Text)*2;
+ } else req[6] = 0;
+ req[current++]=0x00;
+ req[current++]=0x00;
+ }
+
+ if (Number != -1) {
+ req[current++]=UnicodeLength(entry->Entries[Number].Text);
+ memcpy(req+current,DecodeUnicodeString(entry->Entries[Number].Text),UnicodeLength(entry->Entries[Number].Text));
+ current += UnicodeLength(entry->Entries[Number].Text);
+ } else req[current++] = 0;
+
+ /* This allow to save 14 characters name into SIM memory, when
+ * no caller group is selected. */
+ if (Group == -1) {
+ req[current++] = 0xff;
+ } else {
+ req[current++] = entry->Entries[Group].Number-1;
+ }
+
+ smprintf(s, "Writing phonebook entry\n");
+ return GSM_WaitFor (s, req, current, 0x03, 4, ID_SetMemory);
+}
+
+static GSM_Error N6110_DeleteMemory(GSM_StateMachine *s, GSM_MemoryEntry *entry)
+{
+ GSM_MemoryEntry dwa;
+
+ dwa.Location = entry->Location;
+ dwa.MemoryType = entry->MemoryType;
+ dwa.EntriesNum = 0;
+
+ return N6110_SetMemory(s, &dwa);
+}
+
+static GSM_Error N6110_ReplyGetRingtone(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ char buffer[2000];
+ GSM_Error error;
+ int i,end,start;
+
+ smprintf(s, "Ringtone received\n");
+ switch (msg.Buffer[4]) {
+ case 0x00:
+ switch (Data->Ringtone->Format) {
+ case RING_NOTETONE:
+ memcpy(buffer,msg.Buffer,msg.Length);
+ i=7;
+ if (buffer[9]==0x4a && buffer[10]==0x3a) i=8;
+ buffer[i]=0x02;
+ error=GSM_DecodeNokiaRTTLRingtone(Data->Ringtone, buffer+i, msg.Length-i);
+ if (error!=ERR_NONE) return ERR_EMPTY;
+ return ERR_NONE;
+ case RING_NOKIABINARY:
+ i=8;
+ while (msg.Buffer[i]!=0) {
+ i++;
+ if (i>msg.Length) return ERR_EMPTY;
+ }
+ EncodeUnicode(Data->Ringtone->Name,msg.Buffer+8,i-8);
+ smprintf(s, "Name \"%s\"\n",DecodeUnicodeString(Data->Ringtone->Name));
+ /* Looking for start && end */
+ end=0;start=0;i=0;
+ while (true) {
+ if (start!=0) {
+ if (msg.Buffer[i]==0x07 && msg.Buffer[i+1]==0x0b) {
+ end=i+2; break;
+ }
+ if (msg.Buffer[i]==0x0e && msg.Buffer[i+1]==0x0b) {
+ end=i+2; break;
+ }
+ } else {
+ if (msg.Buffer[i]==0x02 && msg.Buffer[i+1]==0xfc && msg.Buffer[i+2]==0x09) {
+ start = i;
+ }
+ }
+ i++;
+ if (i==msg.Length-3) return ERR_EMPTY;
+ }
+ /* Copying frame */
+ memcpy(Data->Ringtone->NokiaBinary.Frame,msg.Buffer+start,end-start);
+ Data->Ringtone->NokiaBinary.Length=end-start;
+#ifdef DEBUG
+ if (di.dl == DL_TEXTALL || di.dl == DL_TEXTALLDATE) DumpMessage(di.df, di.dl, Data->Ringtone->NokiaBinary.Frame, Data->Ringtone->NokiaBinary.Length);
+#endif
+ return ERR_NONE;
+ case RING_MIDI:
+ return ERR_NOTSUPPORTED;
+ }
+ smprintf(s, "Ringtone format is %i\n",Data->Ringtone->Format);
+ break;
+ default:
+ smprintf(s, "Invalid location. Too high ?\n");
+ return ERR_INVALIDLOCATION;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_GetRingtone(GSM_StateMachine *s, GSM_Ringtone *Ringtone, bool PhoneRingtone)
+{
+ GSM_Error error;
+ unsigned char req[] = {0x00, 0x01, 0x9e,
+ 0x00}; /* location */
+
+ if (PhoneRingtone) return ERR_NOTSUPPORTED;
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_NORING)) return ERR_NOTSUPPORTED;
+ if (Ringtone->Location == 0) return ERR_INVALIDLOCATION;
+
+ if (Ringtone->Format == 0x00) {
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_RING_SM)) {
+ Ringtone->Format = RING_NOTETONE;
+ } else {
+ Ringtone->Format = RING_NOKIABINARY;
+ }
+ }
+
+ switch (Ringtone->Format) {
+ case RING_NOTETONE:
+ if (!IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_RING_SM)) return ERR_NOTSUPPORTED;
+ break;
+ case RING_NOKIABINARY:
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_RING_SM)) return ERR_NOTSUPPORTED;
+ break;
+ case RING_MIDI:
+ return ERR_NOTSUPPORTED;
+ }
+
+ error=DCT3_EnableSecurity (s, 0x01);
+ if (error!=ERR_NONE) return error;
+
+ req[3]=Ringtone->Location-1;
+ s->Phone.Data.Ringtone=Ringtone;
+ smprintf(s, "Getting (binary) ringtone\n");
+ return GSM_WaitFor (s, req, 4, 0x40, 4, ID_GetRingtone);
+}
+
+static GSM_Error N6110_ReplyGetSecurityStatus(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ *s->Phone.Data.SecurityStatus = msg.Buffer[4];
+
+#ifdef DEBUG
+ smprintf(s, "Security code status\n");
+ switch(msg.Buffer[4]) {
+ case SEC_SecurityCode: smprintf(s, "waiting for Security Code.\n"); break;
+ case SEC_Pin : smprintf(s, "waiting for PIN.\n"); break;
+ case SEC_Pin2 : smprintf(s, "waiting for PIN2.\n"); break;
+ case SEC_Puk : smprintf(s, "waiting for PUK.\n"); break;
+ case SEC_Puk2 : smprintf(s, "waiting for PUK2.\n"); break;
+ case SEC_None : smprintf(s, "nothing to enter.\n"); break;
+ default : smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+#endif
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_GetSecurityStatus(GSM_StateMachine *s, GSM_SecurityCodeType *Status)
+{
+ unsigned char req[4] = {N6110_FRAME_HEADER, 0x07};
+
+ s->Phone.Data.SecurityStatus=Status;
+ smprintf(s, "Getting security code status\n");
+ return GSM_WaitFor (s, req, 4, 0x08, 2, ID_GetSecurityStatus);
+}
+
+static GSM_Error N6110_ReplyEnterSecurityCode(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ switch (msg.Buffer[3]) {
+ case 0x0b:
+ smprintf(s, "Security code OK\n");
+ return ERR_NONE;
+ case 0x0c:
+ switch (msg.Buffer[4]) {
+ case 0x88:
+ smprintf(s, "Wrong code\n");
+ return ERR_SECURITYERROR;
+ case 0x8b:
+ smprintf(s, "Not required\n");
+ return ERR_NONE;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_EnterSecurityCode(GSM_StateMachine *s, GSM_SecurityCode Code)
+{
+ int len = 0;
+ unsigned char req[15] = {N6110_FRAME_HEADER, 0x0a,
+ 0x00}; /* Type of code to enter */
+
+ req[4]=Code.Type;
+
+ len = strlen(Code.Code);
+ memcpy(req+5,Code.Code,len);
+ req[5+len]=0x00;
+ req[6+len]=0x00;
+
+ smprintf(s, "Entering security code\n");
+ return GSM_WaitFor (s, req, 7+len, 0x08, 4, ID_EnterSecurityCode);
+}
+
+static GSM_Error N6110_ReplyGetSpeedDial(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg.Buffer[3]) {
+ case 0x17:
+ smprintf(s, "Speed dial received\n");
+ switch (msg.Buffer[4]) {
+ case 0x02:
+ Data->SpeedDial->MemoryType = MEM_ME;
+ smprintf(s, "ME ");
+ break;
+ case 0x03:
+ Data->SpeedDial->MemoryType = MEM_SM;
+ smprintf(s, "SIM ");
+ break;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg.Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ Data->SpeedDial->MemoryLocation = msg.Buffer[5];
+ if (msg.Buffer[5] == 0x00) Data->SpeedDial->MemoryLocation = Data->SpeedDial->Location;
+ Data->SpeedDial->MemoryNumberID = 2;
+ smprintf(s, "location %i\n",Data->SpeedDial->MemoryLocation);
+ return ERR_NONE;
+ case 0x18:
+ smprintf(s, "Error getting speed dial. Invalid location\n");
+ return ERR_INVALIDLOCATION;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_GetSpeedDial(GSM_StateMachine *s, GSM_SpeedDial *SpeedDial)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x16,
+ 0x01}; /* location */
+
+ req[4] = SpeedDial->Location;
+
+ s->Phone.Data.SpeedDial=SpeedDial;
+ smprintf(s, "Getting speed dial\n");
+ return GSM_WaitFor (s, req, 5, 0x03, 4, ID_GetSpeedDial);
+}
+
+static GSM_Error N6110_ReplySendDTMF(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ switch (msg.Buffer[3]) {
+ case 0x40:
+ smprintf(s, "During sending DTMF\n");
+ return ERR_NONE;
+ case 0x51:
+ smprintf(s, "DTMF sent OK\n");
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_ReplyGetDisplayStatus(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ int i;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Display status received\n");
+ if (Data->RequestID == ID_GetDisplayStatus) Data->DisplayFeatures->Number=0;
+ for (i=0;i<msg.Buffer[4];i++) {
+ if (msg.Buffer[2*i+6] == 0x02) {
+#ifdef DEBUG
+ switch (msg.Buffer[2*i+5]) {
+ case 0x01: smprintf(s, "Call in progress\n"); break;
+ case 0x02: smprintf(s, "Unknown\n"); break;
+ case 0x03: smprintf(s, "Unread SMS\n"); break;
+ case 0x04: smprintf(s, "Voice call\n"); break;
+ case 0x05: smprintf(s, "Fax call active\n"); break;
+ case 0x06: smprintf(s, "Data call active\n"); break;
+ case 0x07: smprintf(s, "Keyboard lock\n"); break;
+ case 0x08: smprintf(s, "SMS storage full\n"); break;
+ }
+#endif
+ if (Data->RequestID == ID_GetDisplayStatus) {
+ switch (msg.Buffer[2*i+5]) {
+ case 0x01: Data->DisplayFeatures->Feature[Data->DisplayFeatures->Number] = GSM_CallActive;
+ break;
+ case 0x03: Data->DisplayFeatures->Feature[Data->DisplayFeatures->Number] = GSM_UnreadSMS;
+ break;
+ case 0x04: Data->DisplayFeatures->Feature[Data->DisplayFeatures->Number] = GSM_VoiceCall;
+ break;
+ case 0x05: Data->DisplayFeatures->Feature[Data->DisplayFeatures->Number] = GSM_FaxCall;
+ break;
+ case 0x06: Data->DisplayFeatures->Feature[Data->DisplayFeatures->Number] = GSM_DataCall;
+ break;
+ case 0x07: Data->DisplayFeatures->Feature[Data->DisplayFeatures->Number] = GSM_KeypadLocked;
+ break;
+ case 0x08: Data->DisplayFeatures->Feature[Data->DisplayFeatures->Number] = GSM_SMSMemoryFull;
+ break;
+ }
+ if (msg.Buffer[2*i+5]!=0x02) Data->DisplayFeatures->Number++;
+ }
+ }
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_GetDisplayStatus(GSM_StateMachine *s, GSM_DisplayFeatures *features)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x51};
+
+ if (!IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_DISPSTATUS)) return ERR_NOTSUPPORTED;
+
+ s->Phone.Data.DisplayFeatures = features;
+ smprintf(s, "Getting display status\n");
+ return GSM_WaitFor (s, req, 4, 0x0d, 4, ID_GetDisplayStatus);
+}
+
+static GSM_Profile_PhoneTableValue Profile6110[] = {
+ {Profile_KeypadTone, PROFILE_KEYPAD_LEVEL1, 0x00,0x00},
+ {Profile_KeypadTone, PROFILE_KEYPAD_LEVEL2, 0x00,0x01},
+ {Profile_KeypadTone, PROFILE_KEYPAD_LEVEL3, 0x00,0x02},
+ {Profile_KeypadTone, PROFILE_KEYPAD_OFF, 0x00,0xff},
+ {Profile_Lights, PROFILE_LIGHTS_OFF, 0x01,0x00},
+ {Profile_Lights, PROFILE_LIGHTS_AUTO, 0x01,0x01},
+ {Profile_CallAlert, PROFILE_CALLALERT_RINGING, 0x02,0x01},
+ {Profile_CallAlert, PROFILE_CALLALERT_BEEPONCE, 0x02,0x02},
+ {Profile_CallAlert, PROFILE_CALLALERT_OFF, 0x02,0x04},
+ {Profile_CallAlert, PROFILE_CALLALERT_RINGONCE, 0x02,0x05},
+ {Profile_CallAlert, PROFILE_CALLALERT_ASCENDING, 0x02,0x06},
+ {Profile_CallAlert, PROFILE_CALLALERT_CALLERGROUPS,0x02,0x07},
+ /* Ringtone ID */
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL1, 0x04,0x06},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL2, 0x04,0x07},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL3, 0x04,0x08},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL4, 0x04,0x09},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL5, 0x04,0x0a},
+ {Profile_MessageTone, PROFILE_MESSAGE_NOTONE, 0x05,0x00},
+ {Profile_MessageTone, PROFILE_MESSAGE_STANDARD, 0x05,0x01},
+ {Profile_MessageTone, PROFILE_MESSAGE_SPECIAL, 0x05,0x02},
+ {Profile_MessageTone, PROFILE_MESSAGE_BEEPONCE, 0x05,0x03},
+ {Profile_MessageTone, PROFILE_MESSAGE_ASCENDING, 0x05,0x04},
+ {Profile_Vibration, PROFILE_VIBRATION_OFF, 0x06,0x00},
+ {Profile_Vibration, PROFILE_VIBRATION_ON, 0x06,0x01},
+ {Profile_WarningTone, PROFILE_WARNING_OFF, 0x07,0xff},
+ {Profile_WarningTone, PROFILE_WARNING_ON, 0x07,0x04},
+ /* Caller groups */
+ {Profile_AutoAnswer, PROFILE_AUTOANSWER_OFF, 0x09,0x00},
+ {Profile_AutoAnswer, PROFILE_AUTOANSWER_ON, 0x09,0x01},
+ {0x00, 0x00, 0x00,0x00}
+};
+
+static GSM_Profile_PhoneTableValue Profile3310[] = {
+ {Profile_KeypadTone, PROFILE_KEYPAD_LEVEL1, 0x00,0x00},
+ {Profile_KeypadTone, PROFILE_KEYPAD_LEVEL2, 0x00,0x01},
+ {Profile_KeypadTone, PROFILE_KEYPAD_LEVEL3, 0x00,0x02},
+ {Profile_KeypadTone, PROFILE_KEYPAD_OFF, 0x00,0xff},
+ {Profile_CallAlert, PROFILE_CALLALERT_RINGING, 0x01,0x01},
+ {Profile_CallAlert, PROFILE_CALLALERT_BEEPONCE, 0x01,0x02},
+ {Profile_CallAlert, PROFILE_CALLALERT_OFF, 0x01,0x04},
+ {Profile_CallAlert, PROFILE_CALLALERT_RINGONCE, 0x01,0x05},
+ {Profile_CallAlert, PROFILE_CALLALERT_ASCENDING, 0x01,0x06},
+ /* Ringtone ID */
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL1, 0x03,0x06},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL2, 0x03,0x07},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL3, 0x03,0x08},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL4, 0x03,0x09},
+ {Profile_RingtoneVolume, PROFILE_VOLUME_LEVEL5, 0x03,0x0a},
+ {Profile_MessageTone, PROFILE_MESSAGE_NOTONE, 0x04,0x00},
+ {Profile_MessageTone, PROFILE_MESSAGE_STANDARD, 0x04,0x01},
+ {Profile_MessageTone, PROFILE_MESSAGE_SPECIAL, 0x04,0x02},
+ {Profile_MessageTone, PROFILE_MESSAGE_BEEPONCE, 0x04,0x03},
+ {Profile_MessageTone, PROFILE_MESSAGE_ASCENDING, 0x04,0x04},
+ {Profile_MessageTone, PROFILE_MESSAGE_PERSONAL, 0x04,0x05},
+ {Profile_Vibration, PROFILE_VIBRATION_OFF, 0x05,0x00},
+ {Profile_Vibration, PROFILE_VIBRATION_ON, 0x05,0x01},
+ {Profile_Vibration, PROFILE_VIBRATION_FIRST, 0x05,0x02},
+ {Profile_WarningTone, PROFILE_WARNING_OFF, 0x06,0xff},
+ {Profile_WarningTone, PROFILE_WARNING_ON, 0x06,0x04},
+ {Profile_ScreenSaver, PROFILE_SAVER_OFF, 0x07,0x00},
+ {Profile_ScreenSaver, PROFILE_SAVER_ON, 0x07,0x01},
+ {Profile_ScreenSaverTime,PROFILE_SAVER_TIMEOUT_5SEC, 0x08,0x00},
+ {Profile_ScreenSaverTime,PROFILE_SAVER_TIMEOUT_20SEC, 0x08,0x01},
+ {Profile_ScreenSaverTime,PROFILE_SAVER_TIMEOUT_1MIN, 0x08,0x02},
+ {Profile_ScreenSaverTime,PROFILE_SAVER_TIMEOUT_2MIN, 0x08,0x03},
+ {Profile_ScreenSaverTime,PROFILE_SAVER_TIMEOUT_5MIN, 0x08,0x04},
+ {Profile_ScreenSaverTime,PROFILE_SAVER_TIMEOUT_10MIN, 0x08,0x05},
+ {0x00, 0x00, 0x00,0x00}
+};
+
+static GSM_Error N6110_ReplyGetProfileFeature(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg.Buffer[3]) {
+ case 0x14:
+ smprintf(s, "Profile feature %02x with value %02x\n",msg.Buffer[6],msg.Buffer[8]);
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES33)) {
+ switch (msg.Buffer[6]) {
+ case 0x02:
+ smprintf(s, "Ringtone ID\n");
+ Data->Profile->FeatureID [Data->Profile->FeaturesNumber] = Profile_RingtoneID;
+ Data->Profile->FeatureValue [Data->Profile->FeaturesNumber] = msg.Buffer[8];
+ Data->Profile->FeaturesNumber++;
+ break;
+ case 0x09 :
+ smprintf(s, "screen saver number\n");
+ Data->Profile->FeatureID [Data->Profile->FeaturesNumber] = Profile_ScreenSaverNumber;
+ Data->Profile->FeatureValue [Data->Profile->FeaturesNumber] = msg.Buffer[8] + 1;
+ Data->Profile->FeaturesNumber++;
+ break;
+ case 0x24:
+ smprintf(s, "selected profile\n");
+ if (msg.Buffer[8] + 1 == Data->Profile->Location) Data->Profile->Active = true;
+ break;
+ default:
+ NOKIA_FindFeatureValue(s, Profile3310,msg.Buffer[6],msg.Buffer[8],Data,false);
+ }
+ return ERR_NONE;
+ }
+ switch (msg.Buffer[6]) {
+ case 0x01: /* Lights */
+ if (Data->Profile->CarKitProfile) {
+ NOKIA_FindFeatureValue(s, Profile6110,msg.Buffer[6],msg.Buffer[8],Data,false);
+ }
+ break;
+ case 0x03:
+ smprintf(s, "Ringtone ID\n");
+ Data->Profile->FeatureID [Data->Profile->FeaturesNumber] = Profile_RingtoneID;
+ Data->Profile->FeatureValue [Data->Profile->FeaturesNumber] = msg.Buffer[8];
+ Data->Profile->FeaturesNumber++;
+ break;
+ case 0x08: /* Caller groups */
+ if (!IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES51)) {
+ NOKIA_FindFeatureValue(s, Profile6110,msg.Buffer[6],msg.Buffer[8],Data,true);
+ }
+ break;
+ case 0x09: /* Autoanswer */
+ if (Data->Profile->CarKitProfile || Data->Profile->HeadSetProfile) {
+ NOKIA_FindFeatureValue(s, Profile6110,msg.Buffer[6],msg.Buffer[8],Data,false);
+ }
+ break;
+ case 0x2A:
+ smprintf(s, "selected profile\n");
+ if (msg.Buffer[8] + 1 == Data->Profile->Location) Data->Profile->Active = true;
+ break;
+ default:
+ NOKIA_FindFeatureValue(s, Profile6110,msg.Buffer[6],msg.Buffer[8],Data,false);
+ }
+ return ERR_NONE;
+ case 0x15:
+ smprintf(s, "Invalid profile location\n");
+ return ERR_INVALIDLOCATION;
+ case 0x1b:
+ Data->Profile->Name[0] = 0;
+ Data->Profile->Name[1] = 0;
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES33)) {
+ EncodeUnicode(Data->Profile->Name,msg.Buffer+10,msg.Buffer[9]);
+ } else {
+ if (msg.Length > 0x0A) {
+ CopyUnicodeString(Data->Profile->Name,msg.Buffer+10);
+ }
+ }
+ smprintf(s, "Profile name: \"%s\"\n",Data->Profile->Name);
+ Data->Profile->DefaultName = false;
+ if (msg.Buffer[9]==0x00) Data->Profile->DefaultName = true;
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_GetProfile(GSM_StateMachine *s, GSM_Profile *Profile)
+{
+ GSM_Error error;
+ int i,j;
+ unsigned char name_req[] = {N6110_FRAME_HEADER, 0x1a, 0x00};
+ unsigned char feat_req[] = {N6110_FRAME_HEADER, 0x13, 0x01,
+ 0x00, /* Profile location */
+ 0x00}; /* Feature number */
+
+ s->Phone.Data.Profile=Profile;
+
+ smprintf(s, "Getting profile name\n");
+ error = GSM_WaitFor (s, name_req, 5, 0x05, 4, ID_GetProfile);
+ if (error!=ERR_NONE) return error;
+ if (Profile->DefaultName) {
+ NOKIA_GetDefaultProfileName(s, Profile);
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES51)) {
+ switch(Profile->Location) {
+ case 1: EncodeUnicode(Profile->Name,GetMsg(s->msg,"Personal"),strlen(GetMsg(s->msg,"Personal")));
+ break;
+ case 2: EncodeUnicode(Profile->Name,GetMsg(s->msg,"Car"),strlen(GetMsg(s->msg,"Car")));
+ break;
+ case 3: EncodeUnicode(Profile->Name,GetMsg(s->msg,"Headset"),strlen(GetMsg(s->msg,"Headset")));
+ break;
+ }
+ }
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES33)) {
+ switch(Profile->Location) {
+ case 1: EncodeUnicode(Profile->Name,GetMsg(s->msg,"General"),strlen(GetMsg(s->msg,"General")));
+ break;
+ case 2: EncodeUnicode(Profile->Name,GetMsg(s->msg,"Silent"),strlen(GetMsg(s->msg,"Silent")));
+ break;
+ case 3: EncodeUnicode(Profile->Name,GetMsg(s->msg,"Discreet"),strlen(GetMsg(s->msg,"Discreet")));
+ break;
+ case 4: EncodeUnicode(Profile->Name,GetMsg(s->msg,"Loud"),strlen(GetMsg(s->msg,"Loud")));
+ break;
+ case 5: EncodeUnicode(Profile->Name,GetMsg(s->msg,"My style"),strlen(GetMsg(s->msg,"My style")));
+ break;
+ case 6: Profile->Name[0] = 0; Profile->Name[1] = 0;
+ break;
+ }
+ }
+ }
+
+ Profile->FeaturesNumber = 0;
+
+ Profile->CarKitProfile = false;
+ Profile->HeadSetProfile = false;
+ if (Profile->Location == 6) Profile->CarKitProfile = true;
+ if (Profile->Location == 7) Profile->HeadSetProfile = true;
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES51)) {
+ if (Profile->Location == 2) Profile->CarKitProfile = true;
+ if (Profile->Location == 3) Profile->HeadSetProfile = true;
+ }
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES33)) {
+ Profile->HeadSetProfile = false; //fixme
+ Profile->CarKitProfile = false;
+ }
+
+ for (i = 0x00; i <= 0x09; i++) {
+ feat_req[5] = Profile->Location - 1;
+ feat_req[6] = i;
+ smprintf(s, "Getting profile feature\n");
+ error = GSM_WaitFor (s, feat_req, 7, 0x05, 4, ID_GetProfile);
+ if (error!=ERR_NONE) return error;
+ }
+
+ for (i=0;i<Profile->FeaturesNumber;i++) {
+ if (Profile->FeatureID[i] == Profile_CallAlert &&
+ Profile->FeatureValue[i] != PROFILE_CALLALERT_CALLERGROUPS) {
+ for (j=0;j<5;j++) Profile->CallerGroups[j] = true;
+ }
+ }
+
+ Profile->Active = false;
+ feat_req[5] = 0;
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES33)) {
+ feat_req[6] = 0x24;
+ } else {
+ feat_req[6] = 0x2A;
+ }
+ smprintf(s, "Getting profile feature\n");
+ error = GSM_WaitFor (s, feat_req, 7, 0x05, 4, ID_GetProfile);
+
+ return error;
+}
+
+static GSM_Error N6110_SetProfile(GSM_StateMachine *s, GSM_Profile *Profile)
+{
+ int i;
+ bool found;
+ unsigned char ID,Value;
+ GSM_Error error;
+ GSM_Profile_PhoneTableValue *ProfilePhone = Profile6110;
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES33)) ProfilePhone = Profile3310;
+
+ for (i=0;i<Profile->FeaturesNumber;i++) {
+ found = false;
+ if (ProfilePhone == Profile3310) {
+ switch (Profile->FeatureID[i]) {
+ case Profile_RingtoneID:
+ ID = 0x02;
+ Value = Profile->FeatureValue[i];
+ found = true;
+ break;
+ case Profile_ScreenSaverNumber:
+ ID = 0x09;
+ Value = Profile->FeatureValue[i];
+ found = true;
+ break;
+ default:
+ found=NOKIA_FindPhoneFeatureValue(
+ s,
+ ProfilePhone,
+ Profile->FeatureID[i],Profile->FeatureValue[i],
+ &ID,&Value);
+ }
+ }
+ if (ProfilePhone == Profile6110) {
+ switch (Profile->FeatureID[i]) {
+ case Profile_RingtoneID:
+ ID = 0x03;
+ Value = Profile->FeatureValue[i];
+ found = true;
+ break;
+ default:
+ found=NOKIA_FindPhoneFeatureValue(
+ s,
+ ProfilePhone,
+ Profile->FeatureID[i],Profile->FeatureValue[i],
+ &ID,&Value);
+ }
+ }
+ if (found) {
+ error=N6110_SetProfileFeature (s,((unsigned char)(Profile->Location-1)),ID,Value);
+ if (error!=ERR_NONE) return error;
+ }
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_ReplyIncomingSMS(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ GSM_SMSMessage sms;
+
+#ifdef DEBUG
+ smprintf(s, "SMS message received\n");
+ sms.State = SMS_UnRead;
+ sms.InboxFolder = true;
+ DCT3_DecodeSMSFrame(s, &sms,msg.Buffer+7);
+#endif
+ if (Data->EnableIncomingSMS && s->User.IncomingSMS!=NULL) {
+ sms.State = SMS_UnRead;
+ sms.InboxFolder = true;
+ DCT3_DecodeSMSFrame(s, &sms,msg.Buffer+7);
+
+ s->User.IncomingSMS(s->CurrentConfig->Device,sms);
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6110_ReplyAddCalendar(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Writting calendar note: ");
+ switch (msg.Buffer[4]) {
+ case 0x01:
+ smprintf(s, "OK\n");
+ return ERR_NONE;
+ case 0x73:
+ case 0x7d:
+ smprintf(s, "error\n");
+ return ERR_UNKNOWN;
+ case 0x81:
+ smprintf(s,"during editing notes in phone menu\n");
+ return ERR_INSIDEPHONEMENU;
+ default:
+ smprintf(s, "unknown ERROR %i\n",msg.Buffer[4]);
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_AddCalendarNote(GSM_StateMachine *s, GSM_CalendarEntry *Note)
+{
+ bool Reminder3310 = false;
+ int Text, Time, Alarm, Phone, Recurrance, EndTime, Location, i, current;
+ unsigned char mychar1,mychar2;
+ unsigned char req[200] = {N6110_FRAME_HEADER, 0x64, 0x01, 0x10,
+ 0x00, /* Length of the rest of the frame */
+ 0x00, /* Calendar note type */
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x01, 0x00, 0x66, 0x01};
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOCALENDAR)) return ERR_NOTSUPPORTED;
+
+ GSM_CalendarFindDefaultTextTimeAlarmPhoneRecurrance(Note, &Text, &Time, &Alarm, &Phone, &Recurrance, &EndTime, &Location);
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_CAL52)) {
+ switch(Note->Type) {
+ case GSM_CAL_REMINDER: req[7]=0x01; break;
+ case GSM_CAL_CALL : req[7]=0x02; break;
+ case GSM_CAL_MEETING : req[7]=0x03; break;
+ case GSM_CAL_BIRTHDAY: req[7]=0x04; break;
+ case GSM_CAL_T_ATHL : req[7]=0x05; break;
+ case GSM_CAL_T_BALL : req[7]=0x06; break;
+ case GSM_CAL_T_CYCL : req[7]=0x07; break;
+ case GSM_CAL_T_BUDO : req[7]=0x08; break;
+ case GSM_CAL_T_DANC : req[7]=0x09; break;
+ case GSM_CAL_T_EXTR : req[7]=0x0a; break;
+ case GSM_CAL_T_FOOT : req[7]=0x0b; break;
+ case GSM_CAL_T_GOLF : req[7]=0x0c; break;
+ case GSM_CAL_T_GYM : req[7]=0x0d; break;
+ case GSM_CAL_T_HORS : req[7]=0x0e; break;
+ case GSM_CAL_T_HOCK : req[7]=0x0f; break;
+ case GSM_CAL_T_RACE : req[7]=0x10; break;
+ case GSM_CAL_T_RUGB : req[7]=0x11; break;
+ case GSM_CAL_T_SAIL : req[7]=0x12; break;
+ case GSM_CAL_T_STRE : req[7]=0x13; break;
+ case GSM_CAL_T_SWIM : req[7]=0x14; break;
+ case GSM_CAL_T_TENN : req[7]=0x15; break;
+ case GSM_CAL_T_TRAV : req[7]=0x16; break;
+ case GSM_CAL_T_WINT : req[7]=0x17; break;
+ default : req[7]=0x01; break;
+ }
+ } else {
+ switch(Note->Type) {
+ case GSM_CAL_CALL : req[7]=0x02; break;
+ case GSM_CAL_MEETING : req[7]=0x03; break;
+ case GSM_CAL_BIRTHDAY: req[7]=0x04; break;
+ case GSM_CAL_REMINDER:
+ default : req[7]=0x01; break;
+ }
+ }
+
+ if (Time == -1) return ERR_UNKNOWN;
+ NOKIA_EncodeDateTime(s, req+8, &Note->Entries[Time].Date);
+ req[14] = Note->Entries[Time].Date.Second;
+
+ if (Alarm != -1) {
+ NOKIA_EncodeDateTime(s, req+15, &Note->Entries[Alarm].Date);
+ req[21] = Note->Entries[Alarm].Date.Second;
+ }
+
+ current = 23;
+
+ if (Text != -1) {
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_CAL52) ||
+ IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_CAL82)) {
+ req[22] = UnicodeLength(Note->Entries[Text].Text)*2;
+ memcpy(req+current,Note->Entries[Text].Text,UnicodeLength(Note->Entries[Text].Text)*2);
+ current += UnicodeLength(Note->Entries[Text].Text)*2;
+ } else {
+ req[22] = UnicodeLength(Note->Entries[Text].Text);
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_CAL33)) {
+ Reminder3310 = true;
+ if (!strcmp(s->Phone.Data.ModelInfo->model,"3310") && s->Phone.Data.VerNum<5.11) {
+ if (Note->Type!=GSM_CAL_REMINDER) Reminder3310 = false;
+ }
+ if (!strcmp(s->Phone.Data.ModelInfo->model,"3330") && s->Phone.Data.VerNum<=4.50) {
+ if (Note->Type!=GSM_CAL_REMINDER) Reminder3310 = false;
+ }
+ if (Reminder3310) {
+ req[22]++; /* one additional char */
+ req[current++] = 0x01; /* we use now subset 1 */
+ for (i=0;i<((int)UnicodeLength(Note->Entries[Text].Text));i++) {
+ /* Euro char */
+ if (Note->Entries[Text].Text[i*2]==0x20 && Note->Entries[Text].Text[i*2+1]==0xAC) {
+ req[current++] = 0xe2;
+ req[current++] = 0x82;
+ req[current++] = 0xac;
+ req[23] = 0x03; /* use subset 3 */
+ req[22]+=2; /* two additional chars */
+ } else if (EncodeWithUTF8Alphabet(Note->Entries[Text].Text[i*2],Note->Entries[Text].Text[i*2+1],&mychar1,&mychar2)) {
+ req[current++] = mychar1;
+ req[current++] = mychar2;
+ req[23] = 0x03; /* use subset 3 */
+ req[22]++; /* one additional char */
+ } else {
+ current+=DecodeWithUnicodeAlphabet(((wchar_t)(Note->Entries[Text].Text[i*2]*256+Note->Entries[Text].Text[i*2+1])),req+current);
+ }
+ }
+ }
+ }
+ if (!Reminder3310) {
+ memcpy(req+current,DecodeUnicodeString(Note->Entries[Text].Text),UnicodeLength(Note->Entries[Text].Text));
+ current += UnicodeLength(Note->Entries[Text].Text);
+ }
+ }
+ } else req[22] = 0x00;
+
+ if (Note->Type == GSM_CAL_CALL) {
+ if (Phone != -1) {
+ req[current++] = UnicodeLength(Note->Entries[Phone].Text);
+ memcpy(req+current,DecodeUnicodeString(Note->Entries[Phone].Text),UnicodeLength(Note->Entries[Phone].Text));
+ current += UnicodeLength(Note->Entries[Phone].Text);
+ } else req[current++] = 0x00;
+ }
+
+ req[6] = current - 8;
+
+ smprintf(s, "Writing calendar note\n");
+ return GSM_WaitFor (s, req, current, 0x13, 4, ID_SetCalendarNote);
+}
+
+static GSM_Error N6110_ReplyDeleteCalendar(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Deleting calendar note: ");
+ switch (msg.Buffer[4]) {
+ case 0x01:
+ smprintf(s, "done OK\n");
+ return ERR_NONE;
+ case 0x81:
+ smprintf(s,"during editing notes in phone menu\n");
+ return ERR_INSIDEPHONEMENU;
+ case 0x93:
+ smprintf(s, "Can't be done - too high location ?\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "unknown ERROR %i\n",msg.Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+}
+
+static GSM_Error N6110_DeleteCalendarNote(GSM_StateMachine *s, GSM_CalendarEntry *Note)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x68,
+ 0x00}; /* Location */
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOCALENDAR)) return ERR_NOTSUPPORTED;
+
+ req[4] = Note->Location;
+
+ smprintf(s, "Deleting calendar note\n");
+ return GSM_WaitFor (s, req, 5, 0x13, 5, ID_DeleteCalendarNote);
+}
+
+/* for example: "Euro_char" text */
+static void Decode3310Subset3(int j, GSM_Protocol_Message msg, GSM_Phone_Data *Data)
+{
+ wchar_t wc;
+ int len = 0;
+ int i;
+ bool charfound;
+ GSM_CalendarEntry *Entry = Data->Cal;
+
+ i = j;
+ while (i!=msg.Buffer[23]) {
+ EncodeWithUnicodeAlphabet(msg.Buffer+24+i,&wc);
+ charfound = false;
+ if (i!=msg.Buffer[23]-2) {
+ if (msg.Buffer[24+i] ==0xe2 && msg.Buffer[24+i+1]==0x82 &&
+ msg.Buffer[24+i+2]==0xac) {
+ wc = 0x20 * 256 + 0xac;
+ i+=2;
+ charfound = true;
+ }
+ }
+ if (i!=msg.Buffer[23]-1 && !charfound) {
+ if (msg.Buffer[24+i]>=0xc2) {
+ wc = DecodeWithUTF8Alphabet(msg.Buffer[24+i],msg.Buffer[24+i+1]);
+ i++;
+ }
+ }
+ Entry->Entries[Entry->EntriesNum].Text[len++] = (wc >> 8) & 0xff;
+ Entry->Entries[Entry->EntriesNum].Text[len++] = wc & 0xff;
+ i++;
+ }
+ Entry->Entries[Entry->EntriesNum].Text[len++] = 0;
+ Entry->Entries[Entry->EntriesNum].Text[len++] = 0;
+}
+
+/* For example: "a with : above" char */
+static void Decode3310Subset2(int j, GSM_Protocol_Message msg, GSM_Phone_Data *Data)
+{
+ int len = 0;
+ int i;
+ GSM_CalendarEntry *Entry = Data->Cal;
+
+ i = j;
+ while (i!=msg.Buffer[23]) {
+ Entry->Entries[Entry->EntriesNum].Text[len++] = 0x00;
+ Entry->Entries[Entry->EntriesNum].Text[len++] = msg.Buffer[24+i];
+ i++;
+ }
+ Entry->Entries[Entry->EntriesNum].Text[len++] = 0;
+ Entry->Entries[Entry->EntriesNum].Text[len++] = 0;
+}
+
+static GSM_Error N6110_ReplyGetNextCalendar(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ int i = 0;
+ bool SpecialSubSet = false;
+ GSM_CalendarEntry *Entry = s->Phone.Data.Cal;
+
+ switch (msg.Buffer[4]) {
+ case 0x01:
+ smprintf(s, "Calendar note received\n");
+ switch (msg.Buffer[8]) {
+ case 0x01: Entry->Type = GSM_CAL_REMINDER; break;
+ case 0x02: Entry->Type = GSM_CAL_CALL; break;
+ case 0x03: Entry->Type = GSM_CAL_MEETING; break;
+ case 0x04: Entry->Type = GSM_CAL_BIRTHDAY; break;
+ case 0x05: Entry->Type = GSM_CAL_T_ATHL; break;
+ case 0x06: Entry->Type = GSM_CAL_T_BALL; break;
+ case 0x07: Entry->Type = GSM_CAL_T_CYCL; break;
+ case 0x08: Entry->Type = GSM_CAL_T_BUDO; break;
+ case 0x09: Entry->Type = GSM_CAL_T_DANC; break;
+ case 0x0a: Entry->Type = GSM_CAL_T_EXTR; break;
+ case 0x0b: Entry->Type = GSM_CAL_T_FOOT; break;
+ case 0x0c: Entry->Type = GSM_CAL_T_GOLF; break;
+ case 0x0d: Entry->Type = GSM_CAL_T_GYM; break;
+ case 0x0e: Entry->Type = GSM_CAL_T_HORS; break;
+ case 0x0f: Entry->Type = GSM_CAL_T_HOCK; break;
+ case 0x10: Entry->Type = GSM_CAL_T_RACE; break;
+ case 0x11: Entry->Type = GSM_CAL_T_RUGB; break;
+ case 0x12: Entry->Type = GSM_CAL_T_SAIL; break;
+ case 0x13: Entry->Type = GSM_CAL_T_STRE; break;
+ case 0x14: Entry->Type = GSM_CAL_T_SWIM; break;
+ case 0x15: Entry->Type = GSM_CAL_T_TENN; break;
+ case 0x16: Entry->Type = GSM_CAL_T_TRAV; break;
+ case 0x17: Entry->Type = GSM_CAL_T_WINT; break;
+ default :
+ smprintf(s, "Unknown note type %i\n",msg.Buffer[8]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+#ifdef DEBUG
+ switch (msg.Buffer[8]) {
+ case 0x01: smprintf(s, "Reminder\n"); break;
+ case 0x02: smprintf(s, "Call\n"); break;
+ case 0x03: smprintf(s, "Meeting\n"); break;
+ case 0x04: smprintf(s, "Birthday\n"); break;
+ }
+#endif
+ Entry->EntriesNum = 0;
+
+ NOKIA_DecodeDateTime(s, msg.Buffer+9, &Entry->Entries[0].Date);
+ smprintf(s, "Time : %02i-%02i-%04i %02i:%02i:%02i\n",
+ Entry->Entries[0].Date.Day,Entry->Entries[0].Date.Month,Entry->Entries[0].Date.Year,
+ Entry->Entries[0].Date.Hour,Entry->Entries[0].Date.Minute,Entry->Entries[0].Date.Second);
+ Entry->Entries[0].EntryType = CAL_START_DATETIME;
+ Entry->EntriesNum++;
+
+ NOKIA_DecodeDateTime(s, msg.Buffer+16, &Entry->Entries[1].Date);
+ if (Entry->Entries[1].Date.Year!=0) {
+ smprintf(s, "Alarm : %02i-%02i-%04i %02i:%02i:%02i\n",
+ Entry->Entries[1].Date.Day,Entry->Entries[1].Date.Month,Entry->Entries[1].Date.Year,
+ Entry->Entries[1].Date.Hour,Entry->Entries[1].Date.Minute,Entry->Entries[1].Date.Second);
+ Entry->Entries[1].EntryType = CAL_ALARM_DATETIME;
+ Entry->EntriesNum++;
+ } else {
+ smprintf(s, "No alarm\n");
+ }
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_CAL52) ||
+ IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_CAL82)) {
+ memcpy(Entry->Entries[Entry->EntriesNum].Text,msg.Buffer+24,msg.Buffer[23]);
+ Entry->Entries[Entry->EntriesNum].Text[msg.Buffer[23] ]=0;
+ Entry->Entries[Entry->EntriesNum].Text[msg.Buffer[23]+1]=0;
+ } else {
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo,F_CAL33)) {
+ /* first char is subset for 33xx and reminders */
+ if (Entry->Type == GSM_CAL_REMINDER) {
+ i=1;
+ smprintf(s, "Subset %i in reminder note !\n",msg.Buffer[24]);
+ }
+ SpecialSubSet = true;
+ switch (msg.Buffer[24]) {
+ case 2 : Decode3310Subset2(i,msg,&s->Phone.Data); break;
+ case 3 : Decode3310Subset3(i,msg,&s->Phone.Data); break;
+ default : SpecialSubSet = false; break;
+ }
+ }
+ if (!SpecialSubSet) {
+ N6110_EncodeUnicode(s,Entry->Entries[Entry->EntriesNum].Text,msg.Buffer+24+i,msg.Buffer[23]-i);
+ }
+ }
+ smprintf(s, "Text \"%s\"\n",DecodeUnicodeString(Entry->Entries[Entry->EntriesNum].Text));
+ if (msg.Buffer[23] != 0x00) {
+ Entry->Entries[Entry->EntriesNum].EntryType = CAL_TEXT;
+ Entry->EntriesNum++;
+ }
+
+ if (Entry->Type == GSM_CAL_CALL) {
+ EncodeUnicode(Entry->Entries[Entry->EntriesNum].Text,msg.Buffer+24+msg.Buffer[23]+1,msg.Buffer[24+msg.Buffer[23]]);
+ smprintf(s, "Phone : \"%s\"\n",DecodeUnicodeString(Entry->Entries[Entry->EntriesNum].Text));
+ if (msg.Buffer[24+msg.Buffer[23]] != 0x00) {
+ Entry->Entries[Entry->EntriesNum].EntryType = CAL_PHONE;
+ Entry->EntriesNum++;
+ }
+ }
+ return ERR_NONE;
+ case 0x93:
+ smprintf(s, "Can't get calendar note - too high location?\n");
+ return ERR_INVALIDLOCATION;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6110_GetNextCalendarNote(GSM_StateMachine *s, GSM_CalendarEntry *Note, bool start)
+{
+ int Text, Time, Alarm, Phone, Recurrance, EndTime, Location;
+ GSM_Error error;
+ GSM_DateTime date_time;
+ GSM_Phone_N6110Data *Priv = &s->Phone.Data.Priv.N6110;
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x66,
+ 0x00}; /* Location */
+
+ if (IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOCALENDAR)) return ERR_NOTSUPPORTED;
+
+ if (start) {
+ Priv->LastCalendarPos = 1;
+ } else {
+ Priv->LastCalendarPos++;
+ }
+
+ Note->Location = Priv->LastCalendarPos;
+ req[4] = Priv->LastCalendarPos;
+
+ s->Phone.Data.Cal=Note;
+ smprintf(s, "Getting calendar note\n");
+ error=GSM_WaitFor (s, req, 5, 0x13, 4, ID_GetCalendarNote);
+
+ GSM_CalendarFindDefaultTextTimeAlarmPhoneRecurrance(Note, &Text, &Time, &Alarm, &Phone, &Recurrance, &EndTime, &Location);
+ /* 2090 year is set for example in 3310 */
+ if (error == ERR_NONE && Note->Entries[Time].Date.Year == 2090) {
+ error=N6110_GetDateTime(s, &date_time);
+ if (error == ERR_NONE) Note->Entries[Time].Date.Year = date_time.Year;
+ }
+ return error;
+}
+
+GSM_Error N6110_ReplyUSSDInfo(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+ unsigned char buffer[2000],buffer2[4000];
+ int tmp;
+
+ tmp=GSM_UnpackEightBitsToSeven(0, 82, 82, msg.Buffer+8, buffer);
+ msg.Buffer[tmp] = 0;
+
+ smprintf(s, "USSD reply: \"%s\"\n",buffer);
+
+ if (s->Phone.Data.EnableIncomingUSSD && s->User.IncomingUSSD!=NULL) {
+ EncodeUnicode(buffer2,buffer,strlen(buffer));
+ s->User.IncomingUSSD(s->CurrentConfig->Device, buffer2);
+ }
+
+ return ERR_NONE;
+}
+
+GSM_Error N6110_AnswerCall(GSM_StateMachine *s, int ID, bool all)
+{
+ GSM_Error error;
+ unsigned char req1[] = {N6110_FRAME_HEADER, 0x42, 0x05, 0x01,
+ 0x07, 0xa2, 0x88, 0x81, 0x21, 0x15, 0x63, 0xa8,
+ 0x00, 0x00, 0x07, 0xa3, 0xb8, 0x81, 0x20, 0x15,
+ 0x63, 0x80};
+
+ if (!all) {
+ smprintf(s, "Answering call part 1\n");
+ error = GSM_WaitFor (s, req1, 24, 0x01, 5, ID_AnswerCall);
+ if (error != ERR_NONE) return error;
+ return DCT3DCT4_AnswerCall(s,ID);
+ }
+
+ return DCT3_AnswerAllCalls(s);
+}
+
+static GSM_Error N6110_DialVoice(GSM_StateMachine *s, char *number, GSM_CallShowNumber ShowNumber)
+{
+ unsigned int pos = 4;
+ unsigned char req[100] = {N6110_FRAME_HEADER,0x01,
+ 0x0c}; /* Length of number */
+
+ if (ShowNumber == GSM_CALL_DefaultNumberPresence) return DCT3_DialVoice(s,number,ShowNumber);
+
+ req[pos++] = strlen(number);
+ memcpy(req+pos,number,strlen(number));
+ pos += strlen(number);
+ req[pos++] = 0x05; /* call type: voice - 0x05, data - 0x01 */
+ req[pos++] = 0x01;
+ req[pos++] = 0x01;
+ req[pos++] = 0x05;
+ req[pos++] = 0x81;
+ switch (ShowNumber) {
+ case GSM_CALL_HideNumber:
+ req[pos++] = 0x02;
+ break;
+ case GSM_CALL_ShowNumber:
+ req[pos++] = 0x03;
+ break;
+ case GSM_CALL_DefaultNumberPresence:
+ req[pos++] = 0x01;
+ break;
+ }
+ req[pos++] = 0x00;
+ req[pos++] = 0x00;
+
+ smprintf(s, "Making voice call\n");
+ return GSM_WaitFor (s, req, pos, 0x01, 4, ID_DialVoice);
+}
+
+GSM_Error N6110_UnholdCall(GSM_StateMachine *s, int ID)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x24, 0x00, 0x02};
+
+ req[4] = (unsigned char)ID;
+ s->Phone.Data.CallID = ID;
+
+ smprintf(s, "Unholding call\n");
+ return GSM_WaitFor (s, req, 6, 0x01, 4, ID_UnholdCall);
+}
+
+GSM_Error N6110_HoldCall(GSM_StateMachine *s, int ID)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x22, 0x00, 0x00};
+
+ req[4] = (unsigned char)ID;
+ s->Phone.Data.CallID = ID;
+
+ smprintf(s, "Unholding call\n");
+ return GSM_WaitFor (s, req, 6, 0x01, 4, ID_HoldCall);
+}
+
+/* Joining selected call to current (and making conference) */
+GSM_Error N6110_ConferenceCall(GSM_StateMachine *s, int ID)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x28, 0x00, 0x01};
+
+ req[4] = (unsigned char)ID;
+ s->Phone.Data.CallID = ID;
+
+ smprintf(s, "Conference call\n");
+ return GSM_WaitFor (s, req, 6, 0x01, 4, ID_ConferenceCall);
+}
+
+/* Removing selected call from conference and making private call with it
+ * (conference call is on hold) */
+GSM_Error N6110_SplitCall(GSM_StateMachine *s, int ID)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x2A, 0x00, 0x01};
+
+ req[4] = (unsigned char)ID;
+ s->Phone.Data.CallID = ID;
+
+ smprintf(s, "Split call\n");
+ return GSM_WaitFor (s, req, 6, 0x01, 4, ID_SplitCall);
+}
+
+/* This probably need more investigation */
+GSM_Error N6110_SwitchCall(GSM_StateMachine *s, int ID, bool next)
+{
+// unsigned char req[] = {N6110_FRAME_HEADER, 0x20}; calls info
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x26, 0x00};
+
+ s->Phone.Data.CallID = ID;
+
+ if (next) {
+ smprintf(s, "Switch call\n");
+ return GSM_WaitFor (s, req, 4, 0x01, 4, ID_SwitchCall);
+ } else {
+ req[4] = (unsigned char)ID;
+
+ smprintf(s, "Switch call\n");
+ return GSM_WaitFor (s, req, 5, 0x01, 4, ID_SwitchCall);
+ }
+}
+
+/* This probably need more investigation */
+GSM_Error N6110_TransferCall(GSM_StateMachine *s, int ID, bool next)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x2C, 0x00};
+
+ s->Phone.Data.CallID = ID;
+
+ if (next) {
+ smprintf(s, "Transfer call\n");
+ return GSM_WaitFor (s, req, 4, 0x01, 4, ID_TransferCall);
+ } else {
+ req[4] = (unsigned char)ID;
+
+ smprintf(s, "Transfer call\n");
+ return GSM_WaitFor (s, req, 5, 0x01, 4, ID_TransferCall);
+ }
+}
+
+static GSM_Reply_Function N6110ReplyFunctions[] = {
+ {N6110_ReplyCallInfo, "\x01",0x03,0x02,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x03,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x04,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x05,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x07,ID_AnswerCall },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x07,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x09,ID_CancelCall },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x09,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x0A,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x23,ID_HoldCall },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x23,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x25,ID_UnholdCall },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x25,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x27,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x29,ID_ConferenceCall },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x29,ID_IncomingFrame },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x2B,ID_SplitCall },
+ {N6110_ReplyCallInfo, "\x01",0x03,0x2B,ID_IncomingFrame },
+ {N6110_ReplySendDTMF, "\x01",0x03,0x40,ID_SendDTMF },
+ {NoneReply, "\x01",0x03,0x40,ID_DialVoice },
+ {NoneReply, "\x01",0x03,0x40,ID_IncomingFrame },
+ {NoneReply, "\x01",0x03,0x43,ID_AnswerCall },
+ {N6110_ReplySendDTMF, "\x01",0x03,0x51,ID_SendDTMF },
+
+ {DCT3_ReplySendSMSMessage, "\x02",0x03,0x02,ID_IncomingFrame },
+ {DCT3_ReplySendSMSMessage, "\x02",0x03,0x03,ID_IncomingFrame },
+ {N6110_ReplyIncomingSMS, "\x02",0x03,0x10,ID_IncomingFrame },
+#ifdef GSM_ENABLE_CELLBROADCAST
+ {DCT3_ReplySetIncomingCB, "\x02",0x03,0x21,ID_SetIncomingCB },
+ {DCT3_ReplySetIncomingCB, "\x02",0x03,0x22,ID_SetIncomingCB },
+ {DCT3_ReplyIncomingCB, "\x02",0x03,0x23,ID_IncomingFrame },
+#endif
+ {DCT3_ReplySetSMSC, "\x02",0x03,0x31,ID_SetSMSC },
+ {DCT3_ReplyGetSMSC, "\x02",0x03,0x34,ID_GetSMSC },
+ {DCT3_ReplyGetSMSC, "\x02",0x03,0x35,ID_GetSMSC },
+
+ {N6110_ReplyGetMemory, "\x03",0x03,0x02,ID_GetMemory },
+ {N6110_ReplyGetMemory, "\x03",0x03,0x03,ID_GetMemory },
+ {N6110_ReplySetMemory, "\x03",0x03,0x05,ID_SetMemory },
+ {N6110_ReplySetMemory, "\x03",0x03,0x06,ID_SetMemory },
+ {N6110_ReplyGetMemoryStatus, "\x03",0x03,0x08,ID_GetMemoryStatus },
+ {N6110_ReplyGetMemoryStatus, "\x03",0x03,0x09,ID_GetMemoryStatus },
+ {N6110_ReplyGetCallerLogo, "\x03",0x03,0x11,ID_GetBitmap },
+ {N6110_ReplyGetCallerLogo, "\x03",0x03,0x12,ID_GetBitmap },
+ {N6110_ReplySetCallerLogo, "\x03",0x03,0x14,ID_SetBitmap },
+ {N6110_ReplySetCallerLogo, "\x03",0x03,0x15,ID_SetBitmap },
+ {N6110_ReplyGetSpeedDial, "\x03",0x03,0x17,ID_GetSpeedDial },
+ {N6110_ReplyGetSpeedDial, "\x03",0x03,0x18,ID_GetSpeedDial },
+ /* 0x1A, 0x1B - reply set speed dial */
+
+ {N6110_ReplyGetStatus, "\x04",0x03,0x02,ID_GetSignalQuality },
+ {N6110_ReplyGetStatus, "\x04",0x03,0x02,ID_GetBatteryCharge },
+
+ {N6110_ReplySetProfileFeature, "\x05",0x03,0x11,ID_SetProfile },
+ {N6110_ReplySetProfileFeature, "\x05",0x03,0x12,ID_SetProfile },
+ {N6110_ReplyGetProfileFeature, "\x05",0x03,0x14,ID_GetProfile },
+ {N6110_ReplyGetPhoneLanguage, "\x05",0x03,0x14,ID_GetLanguage },
+ {N6110_ReplyGetProfileFeature, "\x05",0x03,0x15,ID_GetProfile },
+ {N6110_ReplyGetPhoneLanguage, "\x05",0x03,0x15,ID_GetLanguage },
+ {N6110_ReplyGetStartup, "\x05",0x03,0x17,ID_GetBitmap },
+ {N6110_ReplySetStartup, "\x05",0x03,0x19,ID_SetBitmap },
+ {N6110_ReplyGetProfileFeature, "\x05",0x03,0x1b,ID_GetProfile },
+ {N61_91_ReplySetOpLogo, "\x05",0x03,0x31,ID_SetBitmap },
+ {N61_91_ReplySetOpLogo, "\x05",0x03,0x32,ID_SetBitmap },
+ {N6110_ReplyGetOpLogo, "\x05",0x03,0x34,ID_GetBitmap },
+ {N6110_ReplySetRingtone, "\x05",0x03,0x37,ID_SetRingtone },
+ {N6110_ReplySetRingtone, "\x05",0x03,0x38,ID_SetRingtone },
+
+ {DCT3DCT4_ReplyCallDivert, "\x06",0x03,0x02,ID_Divert },
+ {DCT3DCT4_ReplyCallDivert, "\x06",0x03,0x03,ID_Divert },
+ {N6110_ReplyUSSDInfo, "\x06",0x03,0x05,ID_IncomingFrame },
+ {NoneReply, "\x06",0x03,0x06,ID_IncomingFrame },//incoming call divert info
+
+ {N6110_ReplyGetSecurityStatus, "\x08",0x03,0x08,ID_GetSecurityStatus },
+ {N6110_ReplyEnterSecurityCode, "\x08",0x03,0x0b,ID_EnterSecurityCode },
+ {N6110_ReplyEnterSecurityCode, "\x08",0x03,0x0c,ID_EnterSecurityCode },
+
+ {DCT3_ReplySIMLogin, "\x09",0x03,0x80,ID_IncomingFrame },
+ {DCT3_ReplySIMLogout, "\x09",0x03,0x81,ID_IncomingFrame },
+
+ {DCT3_ReplyGetNetworkInfo, "\x0A",0x03,0x71,ID_GetNetworkInfo },
+ {DCT3_ReplyGetNetworkInfo, "\x0A",0x03,0x71,ID_IncomingFrame },
+
+ {N6110_ReplyGetDisplayStatus, "\x0D",0x03,0x52,ID_GetDisplayStatus },
+ {N6110_ReplyGetDisplayStatus, "\x0D",0x03,0x52,ID_IncomingFrame },
+
+ {DCT3_ReplySetDateTime, "\x11",0x03,0x61,ID_SetDateTime },
+ {DCT3_ReplyGetDateTime, "\x11",0x03,0x63,ID_GetDateTime },
+ {DCT3_ReplySetAlarm, "\x11",0x03,0x6C,ID_SetAlarm },
+ {DCT3_ReplyGetAlarm, "\x11",0x03,0x6E,ID_GetAlarm },
+
+ {N6110_ReplyAddCalendar, "\x13",0x03,0x65,ID_SetCalendarNote },
+ {N6110_ReplyAddCalendar, "\x13",0x03,0x65,ID_IncomingFrame },
+ {N6110_ReplyGetNextCalendar, "\x13",0x03,0x67,ID_GetCalendarNote },
+ {N6110_ReplyDeleteCalendar, "\x13",0x03,0x69,ID_DeleteCalendarNote },
+ {N6110_ReplyDeleteCalendar, "\x13",0x03,0x69,ID_IncomingFrame },
+
+ {N6110_ReplySaveSMSMessage, "\x14",0x03,0x05,ID_SaveSMSMessage },
+ {N6110_ReplySaveSMSMessage, "\x14",0x03,0x06,ID_SaveSMSMessage },
+ {N6110_ReplyGetSMSMessage, "\x14",0x03,0x08,ID_GetSMSMessage },
+ {N6110_ReplyGetSMSMessage, "\x14",0x03,0x09,ID_GetSMSMessage },
+ {DCT3_ReplyDeleteSMSMessage, "\x14",0x03,0x0B,ID_DeleteSMSMessage },
+ {DCT3_ReplyDeleteSMSMessage, "\x14",0x03,0x0C,ID_DeleteSMSMessage },
+ {N6110_ReplyGetSMSStatus, "\x14",0x03,0x37,ID_GetSMSStatus },
+ {N6110_ReplyGetSMSStatus, "\x14",0x03,0x38,ID_GetSMSStatus },
+
+ {DCT3DCT4_ReplyEnableConnectFunc, "\x3f",0x03,0x01,ID_EnableConnectFunc },
+ {DCT3DCT4_ReplyEnableConnectFunc, "\x3f",0x03,0x02,ID_EnableConnectFunc },
+ {DCT3DCT4_ReplyDisableConnectFunc,"\x3f",0x03,0x04,ID_DisableConnectFunc },
+ {DCT3DCT4_ReplyDisableConnectFunc,"\x3f",0x03,0x05,ID_DisableConnectFunc },
+ {DCT3_ReplyGetWAPBookmark, "\x3f",0x03,0x07,ID_GetWAPBookmark },
+ {DCT3_ReplyGetWAPBookmark, "\x3f",0x03,0x08,ID_GetWAPBookmark },
+ {DCT3DCT4_ReplySetWAPBookmark, "\x3f",0x03,0x0A,ID_SetWAPBookmark },
+ {DCT3DCT4_ReplySetWAPBookmark, "\x3f",0x03,0x0B,ID_SetWAPBookmark },
+ {DCT3DCT4_ReplyDelWAPBookmark, "\x3f",0x03,0x0D,ID_DeleteWAPBookmark },
+ {DCT3DCT4_ReplyDelWAPBookmark, "\x3f",0x03,0x0E,ID_DeleteWAPBookmark },
+ {DCT3DCT4_ReplyGetActiveConnectSet,"\x3f",0x03,0x10,ID_GetConnectSet },
+ {DCT3DCT4_ReplySetActiveConnectSet,"\x3f",0x03,0x13,ID_SetConnectSet },
+ {DCT3_ReplyGetWAPSettings, "\x3f",0x03,0x16,ID_GetConnectSet },
+ {DCT3_ReplyGetWAPSettings, "\x3f",0x03,0x17,ID_GetConnectSet },
+ {DCT3_ReplySetWAPSettings, "\x3f",0x03,0x19,ID_SetConnectSet },
+ {DCT3_ReplySetWAPSettings, "\x3f",0x03,0x1A,ID_SetConnectSet },
+ {DCT3_ReplyGetWAPSettings, "\x3f",0x03,0x1C,ID_GetConnectSet },
+ {DCT3_ReplyGetWAPSettings, "\x3f",0x03,0x1D,ID_GetConnectSet },
+ {DCT3_ReplySetWAPSettings, "\x3f",0x03,0x1F,ID_SetConnectSet },
+
+ {DCT3_ReplyEnableSecurity, "\x40",0x02,0x64,ID_EnableSecurity },
+ {N61_71_ReplyResetPhoneSettings, "\x40",0x02,0x65,ID_ResetPhoneSettings },
+ {DCT3_ReplyGetIMEI, "\x40",0x02,0x66,ID_GetIMEI },
+ {DCT3_ReplyDialCommand, "\x40",0x02,0x7C,ID_DialVoice },
+ {DCT3_ReplyDialCommand, "\x40",0x02,0x7C,ID_CancelCall },
+ {DCT3_ReplyDialCommand, "\x40",0x02,0x7C,ID_AnswerCall },
+ {DCT3_ReplyNetmonitor, "\x40",0x02,0x7E,ID_Netmonitor },
+ {DCT3_ReplyPlayTone, "\x40",0x02,0x8F,ID_PlayTone },
+ {N6110_ReplyGetRingtone, "\x40",0x02,0x9E,ID_GetRingtone },
+ {N6110_ReplySetBinRingtone, "\x40",0x02,0xA0,ID_SetRingtone },
+ {NOKIA_ReplyGetPhoneString, "\x40",0x02,0xC8,ID_GetHardware },
+ {NOKIA_ReplyGetPhoneString, "\x40",0x02,0xC8,ID_GetPPM },
+ {NOKIA_ReplyGetPhoneString, "\x40",0x02,0xCA,ID_GetProductCode },
+ {NOKIA_ReplyGetPhoneString, "\x40",0x02,0xCC,ID_GetManufactureMonth},
+ {NOKIA_ReplyGetPhoneString, "\x40",0x02,0xCC,ID_GetOriginalIMEI },
+
+ {N6110_ReplyGetSetPicture, "\x47",0x03,0x02,ID_GetBitmap },
+ {N6110_ReplyGetSetPicture, "\x47",0x03,0x04,ID_SetBitmap },
+ {N6110_ReplyGetSetPicture, "\x47",0x03,0x05,ID_SetBitmap },
+ {N6110_ReplyGetSetPicture, "\x47",0x03,0x06,ID_GetBitmap },
+
+#ifndef ENABLE_LGPL
+ {N6110_ReplyGetMagicBytes, "\x64",0x00,0x00,ID_MakeAuthentication },
+#endif
+
+ {DCT3DCT4_ReplyGetModelFirmware, "\xD2",0x02,0x00,ID_GetModel },
+ {DCT3DCT4_ReplyGetModelFirmware, "\xD2",0x02,0x00,ID_GetFirmware },
+ {DCT3_ReplyPressKey, "\xD2",0x02,0x46,ID_PressKey },
+ {DCT3_ReplyPressKey, "\xD2",0x02,0x47,ID_PressKey },
+
+ {NULL, "\x00",0x00,0x00,ID_None }
+};
+
+GSM_Phone_Functions N6110Phone = {
+ "2100|3210|3310|3330|3390|3410|3610|5110|5110i|5130|5190|5210|5510|6110|6130|6150|6190|8210|8250|8290|8850|8855|8890",
+ N6110ReplyFunctions,
+ N6110_Initialise,
+ PHONE_Terminate,
+ GSM_DispatchMessage,
+ N6110_ShowStartInfo,
+ NOKIA_GetManufacturer,
+ DCT3DCT4_GetModel,
+ DCT3DCT4_GetFirmware,
+ DCT3_GetIMEI,
+ DCT3_GetOriginalIMEI,
+ DCT3_GetManufactureMonth,
+ DCT3_GetProductCode,
+ DCT3_GetHardware,
+ DCT3_GetPPM,
+ NOTSUPPORTED, /* GetSIMIMSI */
+ N6110_GetDateTime,
+ N6110_SetDateTime,
+ N6110_GetAlarm,
+ N6110_SetAlarm,
+ NOTSUPPORTED, /* GetLocale */
+ NOTSUPPORTED, /* SetLocale */
+ DCT3_PressKey,
+ DCT3_Reset,
+ N61_71_ResetPhoneSettings,
+ N6110_EnterSecurityCode,
+ N6110_GetSecurityStatus,
+ N6110_GetDisplayStatus,
+ NOTIMPLEMENTED, /* SetAutoNetworkLogin */
+ N6110_GetBatteryCharge,
+ N6110_GetSignalQuality,
+ DCT3_GetNetworkInfo,
+ NOTSUPPORTED, /* GetCategory */
+ NOTSUPPORTED, /* AddCategory */
+ NOTSUPPORTED, /* GetCategoryStatus */
+ N6110_GetMemoryStatus,
+ N6110_GetMemory,
+ NOTIMPLEMENTED, /* GetNextMemory */
+ N6110_SetMemory,
+ NOTIMPLEMENTED, /* AddMemory */
+ N6110_DeleteMemory,
+ NOTIMPLEMENTED, /* DeleteAllMemory */
+ N6110_GetSpeedDial,
+ NOTIMPLEMENTED, /* SetSpeedDial */
+ DCT3_GetSMSC,
+ DCT3_SetSMSC,
+ DCT3_GetSMSStatus,
+ N6110_GetSMSMessage,
+ N6110_GetNextSMSMessage,
+ N6110_SetSMS,
+ N6110_AddSMS,
+ N6110_DeleteSMSMessage,
+ DCT3_SendSMSMessage,
+ NOTSUPPORTED, /* SendSavedSMS */
+ NOKIA_SetIncomingSMS,
+ DCT3_SetIncomingCB,
+ PHONE_GetSMSFolders,
+ NOTSUPPORTED, /* AddSMSFolder */
+ NOTSUPPORTED, /* DeleteSMSFolder */
+ N6110_DialVoice,
+ N6110_AnswerCall,
+ DCT3_CancelCall,
+ N6110_HoldCall,
+ N6110_UnholdCall,
+ N6110_ConferenceCall,
+ N6110_SplitCall,
+ N6110_TransferCall,
+ N6110_SwitchCall,
+ DCT3DCT4_GetCallDivert,
+ DCT3DCT4_SetCallDivert,
+ DCT3DCT4_CancelAllDiverts,
+ NOKIA_SetIncomingCall,
+ NOKIA_SetIncomingUSSD,
+ DCT3DCT4_SendDTMF,
+ N6110_GetRingtone,
+ N6110_SetRingtone,
+ NOTSUPPORTED, /* GetRingtonesInfo */
+ NOTSUPPORTED, /* DeleteUserRingtones */
+ DCT3_PlayTone,
+ DCT3_GetWAPBookmark,
+ DCT3_SetWAPBookmark,
+ DCT3_DeleteWAPBookmark,
+ DCT3_GetWAPSettings,
+ DCT3_SetWAPSettings,
+ NOTSUPPORTED, /* GetMMSSettings */
+ NOTSUPPORTED, /* SetMMSSettings */
+ NOTSUPPORTED, /* GetSyncMLSettings */
+ NOTSUPPORTED, /* SetSyncMLSettings */
+ NOTSUPPORTED, /* GetChatSettings */
+ NOTSUPPORTED, /* SetChatSettings */
+ N6110_GetBitmap,
+ N6110_SetBitmap,
+ NOTSUPPORTED, /* GetToDoStatus */
+ NOTSUPPORTED, /* GetToDo */
+ NOTSUPPORTED, /* GetNextToDo */
+ NOTSUPPORTED, /* SetToDo */
+ NOTSUPPORTED, /* AddToDo */
+ NOTSUPPORTED, /* DeleteToDo */
+ NOTSUPPORTED, /* DeleteAllToDo */
+ NOTIMPLEMENTED, /* GetCalendarStatus */
+ NOTIMPLEMENTED, /* GetCalendar */
+ N6110_GetNextCalendarNote,
+ NOTIMPLEMENTED, /* SetCalendar */
+ N6110_AddCalendarNote,
+ N6110_DeleteCalendarNote,
+ NOTIMPLEMENTED, /* DeleteAllCalendar */
+ NOTSUPPORTED, /* GetCalendarSettings */
+ NOTSUPPORTED, /* SetCalendarSettings */
+ NOTSUPPORTED, /* GetNote */
+ N6110_GetProfile,
+ N6110_SetProfile,
+ NOTSUPPORTED, /* GetFMStation */
+ NOTSUPPORTED, /* SetFMStation */
+ NOTSUPPORTED, /* ClearFMStations */
+ NOTSUPPORTED, /* GetNextFileFolder */
+ NOTSUPPORTED, /* GetFilePart */
+ NOTSUPPORTED, /* AddFile */
+ NOTSUPPORTED, /* GetFileSystemStatus */
+ NOTSUPPORTED, /* DeleteFile */
+ NOTSUPPORTED, /* AddFolder */
+ NOTSUPPORTED, /* GetGPRSAccessPoint */
+ NOTSUPPORTED /* SetGPRSAccessPoint */
+};
+
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */