summaryrefslogtreecommitdiff
path: root/libgammu/phone/nokia/dct4s40/6510
diff options
context:
space:
mode:
Diffstat (limited to 'libgammu/phone/nokia/dct4s40/6510')
-rw-r--r--libgammu/phone/nokia/dct4s40/6510/6510cal.c1353
-rw-r--r--libgammu/phone/nokia/dct4s40/6510/6510cal.h51
-rw-r--r--libgammu/phone/nokia/dct4s40/6510/6510file.c2609
-rw-r--r--libgammu/phone/nokia/dct4s40/6510/6510file.h32
-rw-r--r--libgammu/phone/nokia/dct4s40/6510/n6510.c4627
-rw-r--r--libgammu/phone/nokia/dct4s40/6510/n6510.h127
6 files changed, 8799 insertions, 0 deletions
diff --git a/libgammu/phone/nokia/dct4s40/6510/6510cal.c b/libgammu/phone/nokia/dct4s40/6510/6510cal.c
new file mode 100644
index 0000000..a5a70d0
--- /dev/null
+++ b/libgammu/phone/nokia/dct4s40/6510/6510cal.c
@@ -0,0 +1,1353 @@
+/* (c) 2002-2005 by Marcin Wiacek */
+
+#include <gammu-config.h>
+
+#ifdef GSM_ENABLE_NOKIA6510
+
+#include <string.h>
+#include <time.h>
+
+#include "../../../../misc/coding/coding.h"
+#include "../../../../gsmcomon.h"
+#include "../../../../service/gsmlogo.h"
+#include "../../../../service/gsmcal.h"
+#include "../../nfunc.h"
+#include "../../nfuncold.h"
+#include "../../../pfunc.h"
+#include "../dct4func.h"
+#include "n6510.h"
+
+/* method 3 */
+GSM_Error N6510_ReplyGetCalendarInfo3(GSM_Protocol_Message *msg, GSM_StateMachine *s, GSM_NOKIACalToDoLocations *Last)
+{
+ size_t i=0,j=0;
+
+ while (Last->Location[j] != 0x00) j++;
+ if (j >= GSM_MAXCALENDARTODONOTES) {
+ smprintf(s, "Increase GSM_MAXCALENDARTODONOTES\n");
+ return ERR_MOREMEMORY;
+ }
+ if (j == 0) {
+ Last->Number = msg->Buffer[8]*256 + msg->Buffer[9];
+ smprintf(s, "Number of Entries: %i\n", Last->Number);
+ }
+ smprintf(s, "Locations: ");
+ while (14+(i*4) <= msg->Length) {
+ Last->Location[j] = msg->Buffer[12+i*4]*256 + msg->Buffer[13+i*4];
+ smprintf(s, "%i ", Last->Location[j]);
+ i++;
+ j++;
+ }
+ smprintf(s, "\nNumber of Entries in frame: %ld\n", (long)i);
+ Last->Location[j] = 0;
+ smprintf(s, "\n");
+ if (i == 1 && msg->Buffer[12+0*4]*256+msg->Buffer[13+0*4] == 0) return ERR_EMPTY;
+ if (i == 0) return ERR_EMPTY;
+ return ERR_NONE;
+}
+
+/* method 3 */
+GSM_Error N6510_GetCalendarInfo3(GSM_StateMachine *s, GSM_NOKIACalToDoLocations *Last, char Type)
+{
+ GSM_Error error = ERR_UNKNOWN;
+ int i;
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x9E, 0xFF, 0xFF, 0x00, 0x00,
+ 0x00, 0x00, /* First location */
+ 0x00}; /* 0 = calendar, 1 = ToDo in 6610 style, 2 = Notes */
+
+ Last->Location[0] = 0x00;
+ Last->Number = 0;
+
+ req[10] = Type;
+ if (Type == 0) {
+ smprintf(s, "Getting locations for calendar method 3\n");
+ error = GSM_WaitFor (s, req, 11, 0x13, 4, ID_GetCalendarNotesInfo);
+ } else if (Type == 1) {
+ smprintf(s, "Getting locations for ToDo method 2\n");
+ error = GSM_WaitFor (s, req, 11, 0x13, 4, ID_GetToDo);
+ } else if (Type == 2) {
+ smprintf(s, "Getting locations for Notes\n");
+ error = GSM_WaitFor (s, req, 11, 0x13, 4, ID_GetNote);
+ }
+ if (error != ERR_NONE && error != ERR_EMPTY) return error;
+
+ while (1) {
+ i=0;
+ while (Last->Location[i] != 0x00) i++;
+ smprintf(s, "i = %i last_number = %i\n",i,Last->Number);
+ if (i == Last->Number) break;
+ if (i != Last->Number && error == ERR_EMPTY) {
+ smprintf(s, "Phone doesn't support some notes with this method. Workaround\n");
+ Last->Number = i;
+ break;
+ }
+ req[8] = Last->Location[i-1] / 256;
+ req[9] = Last->Location[i-1] % 256;
+ if (Type == 0) {
+ smprintf(s, "Getting locations for calendar method 3\n");
+ error = GSM_WaitFor (s, req, 11, 0x13, 4, ID_GetCalendarNotesInfo);
+ } else if (Type == 1) {
+ smprintf(s, "Getting locations for todo method 2\n");
+ error = GSM_WaitFor (s, req, 11, 0x13, 4, ID_GetToDo);
+ } else if (Type == 2) {
+ smprintf(s, "Getting locations for Notes\n");
+ error = GSM_WaitFor (s, req, 11, 0x13, 4, ID_GetNote);
+ }
+ if (error != ERR_NONE && error != ERR_EMPTY) return error;
+ }
+ return ERR_NONE;
+}
+
+/* method 3 */
+GSM_Error N6510_ReplyGetCalendar3(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_CalendarEntry *entry = s->Phone.Data.Cal;
+ unsigned long diff;
+ int i;
+ gboolean found = FALSE;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int len;
+
+ smprintf(s, "Calendar note received method 3\n");
+
+ smprintf(s,"Note type %02i: ",msg->Buffer[27]);
+ switch(msg->Buffer[27]) {
+ case 0x00: smprintf(s,"Reminder\n"); entry->Type = GSM_CAL_REMINDER; break;
+ case 0x01: smprintf(s,"Meeting\n"); entry->Type = GSM_CAL_MEETING; break;
+ case 0x02: smprintf(s,"Call\n"); entry->Type = GSM_CAL_CALL; break;
+ case 0x04: smprintf(s,"Birthday\n"); entry->Type = GSM_CAL_BIRTHDAY; break;
+ case 0x08: smprintf(s,"Memo\n"); entry->Type = GSM_CAL_MEMO; break;
+ case 0x20: smprintf(s,"Birthday\n"); entry->Type = GSM_CAL_BIRTHDAY; break;
+ default : smprintf(s,"unknown\n"); entry->Type = GSM_CAL_MEMO;
+ }
+
+ smprintf(s,"StartTime: %04i-%02i-%02i %02i:%02i\n",
+ msg->Buffer[28]*256+msg->Buffer[29],
+ msg->Buffer[30],msg->Buffer[31],msg->Buffer[32],
+ msg->Buffer[33]);
+ GSM_GetCurrentDateTime(&entry->Entries[0].Date);
+ entry->Entries[0].Date.Year = msg->Buffer[28]*256+msg->Buffer[29];
+ if (entry->Type == GSM_CAL_BIRTHDAY) {
+ entry->Entries[0].Date.Year = entry->Entries[0].Date.Year;
+ smprintf(s,"%i\n",entry->Entries[0].Date.Year);
+ }
+ entry->Entries[0].Date.Month = msg->Buffer[30];
+ entry->Entries[0].Date.Day = msg->Buffer[31];
+ entry->Entries[0].Date.Hour = msg->Buffer[32];
+ entry->Entries[0].Date.Minute = msg->Buffer[33];
+ /* Garbage seen with 3510i 3.51 */
+ if (entry->Entries[0].Date.Month == 0 &&
+ entry->Entries[0].Date.Day == 0 &&
+ entry->Entries[0].Date.Hour == 0 &&
+ entry->Entries[0].Date.Minute == 0)
+ return ERR_EMPTY;
+ entry->Entries[0].Date.Second = 0;
+ entry->Entries[0].EntryType = CAL_START_DATETIME;
+ entry->EntriesNum++;
+
+ GSM_GetCalendarRecurranceRepeat(&(s->di), msg->Buffer+40, msg->Buffer+46, entry);
+
+ if (entry->Type != GSM_CAL_BIRTHDAY) {
+ smprintf(s,"EndTime: %04i-%02i-%02i %02i:%02i\n",
+ msg->Buffer[34]*256+msg->Buffer[35],
+ msg->Buffer[36],msg->Buffer[37],msg->Buffer[38],
+ msg->Buffer[39]);
+ entry->Entries[entry->EntriesNum].Date.Year = msg->Buffer[34]*256+msg->Buffer[35];
+ entry->Entries[entry->EntriesNum].Date.Month = msg->Buffer[36];
+ entry->Entries[entry->EntriesNum].Date.Day = msg->Buffer[37];
+ entry->Entries[entry->EntriesNum].Date.Hour = msg->Buffer[38];
+ entry->Entries[entry->EntriesNum].Date.Minute = msg->Buffer[39];
+ entry->Entries[entry->EntriesNum].Date.Second = 0;
+ entry->Entries[entry->EntriesNum].EntryType = CAL_END_DATETIME;
+ entry->EntriesNum++;
+ }
+
+ smprintf(s, "Note icon: %02x\n",msg->Buffer[21]);
+ for(i=0;i<Priv->CalendarIconsNum;i++) {
+ if (Priv->CalendarIconsTypes[i] == entry->Type) {
+ found = TRUE;
+ }
+ }
+ if (!found) {
+ Priv->CalendarIconsTypes[Priv->CalendarIconsNum] = entry->Type;
+ Priv->CalendarIcons [Priv->CalendarIconsNum] = msg->Buffer[21];
+ Priv->CalendarIconsNum++;
+ }
+
+ if (msg->Buffer[14] == 0xFF && msg->Buffer[15] == 0xFF && msg->Buffer[16] == 0xff && msg->Buffer[17] == 0xff) {
+ smprintf(s, "No alarm\n");
+ } else {
+ diff = ((unsigned int)msg->Buffer[14]) << 24;
+ diff += ((unsigned int)msg->Buffer[15]) << 16;
+ diff += ((unsigned int)msg->Buffer[16]) << 8;
+ diff += msg->Buffer[17];
+
+ memcpy(&entry->Entries[entry->EntriesNum].Date,&entry->Entries[0].Date,sizeof(GSM_DateTime));
+ GetTimeDifference(diff, &entry->Entries[entry->EntriesNum].Date, FALSE, 60);
+ smprintf(s, "Alarm date : %02i-%02i-%04i %02i:%02i:%02i\n",
+ entry->Entries[entry->EntriesNum].Date.Day, entry->Entries[entry->EntriesNum].Date.Month,
+ entry->Entries[entry->EntriesNum].Date.Year, entry->Entries[entry->EntriesNum].Date.Hour,
+ entry->Entries[entry->EntriesNum].Date.Minute,entry->Entries[entry->EntriesNum].Date.Second);
+
+ entry->Entries[entry->EntriesNum].EntryType = CAL_TONE_ALARM_DATETIME;
+ if (msg->Buffer[22]==0x00 && msg->Buffer[23]==0x00 &&
+ msg->Buffer[24]==0x00 && msg->Buffer[25]==0x00) {
+ entry->Entries[entry->EntriesNum].EntryType = CAL_SILENT_ALARM_DATETIME;
+ smprintf(s, "Alarm type : Silent\n");
+ }
+ entry->EntriesNum++;
+ }
+
+ if (entry->Type == GSM_CAL_BIRTHDAY) {
+ if (msg->Buffer[42] == 0xff && msg->Buffer[43] == 0xff) {
+ entry->Entries[0].Date.Year = 0;
+ } else {
+ entry->Entries[0].Date.Year = msg->Buffer[42]*256+msg->Buffer[43];
+ }
+ }
+
+ len = msg->Buffer[50] * 256 + msg->Buffer[51];
+ if (len > GSM_MAX_CALENDAR_TEXT_LENGTH) {
+ smprintf(s, "Calendar text too long (%d), truncating to %d\n", len, GSM_MAX_CALENDAR_TEXT_LENGTH);
+ len = GSM_MAX_CALENDAR_TEXT_LENGTH;
+ }
+ memcpy(entry->Entries[entry->EntriesNum].Text,
+ msg->Buffer + 54,
+ len * 2);
+ entry->Entries[entry->EntriesNum].Text[len * 2] = 0;
+ entry->Entries[entry->EntriesNum].Text[len * 2 + 1] = 0;
+ entry->Entries[entry->EntriesNum].EntryType = CAL_TEXT;
+ entry->EntriesNum++;
+ smprintf(s, "Note text: \"%s\"\n",DecodeUnicodeString(entry->Entries[entry->EntriesNum-1].Text));
+
+ if (entry->Type == GSM_CAL_CALL) {
+ memcpy(entry->Entries[entry->EntriesNum].Text, msg->Buffer+(54+msg->Buffer[51]*2), msg->Buffer[52]*2);
+ entry->Entries[entry->EntriesNum].Text[msg->Buffer[52]*2] = 0;
+ entry->Entries[entry->EntriesNum].Text[msg->Buffer[52]*2+1] = 0;
+ entry->Entries[entry->EntriesNum].EntryType = CAL_PHONE;
+ entry->EntriesNum++;
+ }
+ if (entry->Type == GSM_CAL_MEETING) {
+ memcpy(entry->Entries[entry->EntriesNum].Text, msg->Buffer+(54+msg->Buffer[51]*2), msg->Buffer[52]*2);
+ entry->Entries[entry->EntriesNum].Text[msg->Buffer[52]*2] = 0;
+ entry->Entries[entry->EntriesNum].Text[msg->Buffer[52]*2+1] = 0;
+ entry->Entries[entry->EntriesNum].EntryType = CAL_LOCATION;
+ entry->EntriesNum++;
+ }
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_PrivGetGenericCalendar3(GSM_StateMachine *s, int Location, GSM_Phone_RequestID ID)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER,0x7D,0x00,0x00,0x00,0x00,
+ 0x00,0x99, /* Location */
+ 0xff,0xff,0xff,0xff};
+
+ req[8] = Location / 256;
+ req[9] = Location % 256;
+
+ return GSM_WaitFor (s, req, 14, 0x13, 4, ID);
+}
+
+static GSM_Error N6510_PrivGetCalendar3(GSM_StateMachine *s, GSM_CalendarEntry *Note, gboolean start, int *LastCalendarYear)
+{
+ GSM_Error error;
+ GSM_DateTime date_time;
+
+ if (start) {
+ /* We have to get current year. It's NOT written in frame for
+ * Birthday
+ */
+ error=s->Phone.Functions->GetDateTime(s,&date_time);
+ switch (error) {
+ case ERR_EMPTY:
+ case ERR_NOTIMPLEMENTED:
+ GSM_GetCurrentDateTime(&date_time);
+ break;
+ case ERR_NONE:
+ break;
+ default:
+ return error;
+ }
+ *LastCalendarYear = date_time.Year;
+ }
+
+ Note->EntriesNum = 0;
+ Note->Entries[0].Date.Year = *LastCalendarYear;
+
+ s->Phone.Data.Cal=Note;
+ smprintf(s, "Getting calendar note method 3\n");
+ return N6510_PrivGetGenericCalendar3(s, Note->Location, ID_GetCalendarNote);
+}
+
+/* method 3 */
+static GSM_Error N6510_GetNextCalendar3(GSM_StateMachine *s, GSM_CalendarEntry *Note, gboolean start, GSM_NOKIACalToDoLocations *LastCalendar, int *LastCalendarYear, int *LastCalendarPos)
+{
+ GSM_Error error;
+ gboolean start2;
+
+ if (start) {
+ error=N6510_GetCalendarInfo3(s,LastCalendar,0);
+ if (error!=ERR_NONE) return error;
+ if (LastCalendar->Number == 0) return ERR_EMPTY;
+
+ *LastCalendarPos = 0;
+ } else {
+ (*LastCalendarPos)++;
+ }
+
+ error = ERR_EMPTY;
+ start2 = start;
+ while (error == ERR_EMPTY) {
+ if (*LastCalendarPos >= LastCalendar->Number) return ERR_EMPTY;
+
+ Note->Location = LastCalendar->Location[*LastCalendarPos];
+ error=N6510_PrivGetCalendar3(s, Note, start2, LastCalendarYear);
+ if (error == ERR_EMPTY) (*LastCalendarPos)++;
+
+ start2 = FALSE;
+ }
+ return error;
+}
+
+GSM_Error N6510_ReplyGetCalendarInfo(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[3]) {
+ case 0x3B:
+ /* Old method 1 for accessing calendar */
+ return N71_65_ReplyGetCalendarInfo1(msg, s, &s->Phone.Data.Priv.N6510.LastCalendar);
+ case 0x9F:
+ smprintf(s, "Info with calendar notes locations received method 3\n");
+ return N6510_ReplyGetCalendarInfo3(msg, s, &s->Phone.Data.Priv.N6510.LastCalendar);
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+/* method 3 */
+GSM_Error N6510_ReplyGetCalendarNotePos3(GSM_Protocol_Message *msg, GSM_StateMachine *s,int *FirstCalendarPos)
+{
+ smprintf(s, "First calendar location: %i\n",msg->Buffer[8]*256+msg->Buffer[9]);
+ *FirstCalendarPos = msg->Buffer[8]*256+msg->Buffer[9];
+ return ERR_NONE;
+}
+
+/* method 3 */
+static GSM_Error N6510_GetCalendarNotePos3(GSM_StateMachine *s)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x95, 0x00};
+
+ smprintf(s, "Getting first free calendar note location\n");
+ return GSM_WaitFor (s, req, 5, 0x13, 4, ID_GetCalendarNotePos);
+}
+
+GSM_Error N6510_ReplyGetCalendarNotePos(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[3]) {
+ case 0xf0:
+ return ERR_NOTSUPPORTED;
+ case 0x32:
+ /* Old method 1 for accessing calendar */
+ return N71_65_ReplyGetCalendarNotePos1(msg, s,&s->Phone.Data.Priv.N6510.FirstCalendarPos);
+ case 0x96:
+ return N6510_ReplyGetCalendarNotePos3(msg, s,&s->Phone.Data.Priv.N6510.FirstCalendarPos);
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_FindCalendarIconID3(GSM_StateMachine *s, GSM_CalendarEntry *Entry, unsigned char *ID)
+{
+ int i,j,LastCalendarYear;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_CalendarEntry Note;
+ GSM_NOKIACalToDoLocations LastCalendar1,LastCalendar2;
+ GSM_Error error;
+ gboolean found;
+
+ for(i=0;i<Priv->CalendarIconsNum;i++) {
+ if (Priv->CalendarIconsTypes[i] == Entry->Type) {
+ *ID = Priv->CalendarIcons[i];
+ return ERR_NONE;
+ }
+ }
+
+ smprintf(s, "Starting finding note ID\n");
+
+ error=N6510_GetCalendarInfo3(s, &Priv->LastCalendar,0);
+ memcpy(&LastCalendar1,&Priv->LastCalendar,sizeof(GSM_NOKIACalToDoLocations));
+ if (error != ERR_NONE) return error;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL35) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL65) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL62)) {
+ error=N71_65_AddCalendar2(s,Entry);
+ } else {
+ /* First method 1 was used for meeting only
+ * but it made problems with 6230 RH-12 4.44
+ * (probably for other Series 40 2.0 phones too)
+ * For now meeting, call and memo uses method 1
+ * Please note, that method 1 is the oldest one and in some
+ * moment Nokia can remove it from firmware
+ */
+/* if (Entry->Type == GSM_CAL_MEETING) { */
+ if (Entry->Type == GSM_CAL_MEETING || Entry->Type == GSM_CAL_CALL || Entry->Type == GSM_CAL_MEMO) {
+ error=N71_65_AddCalendar1(s, Entry, &s->Phone.Data.Priv.N6510.FirstCalendarPos);
+ } else {
+ error=N71_65_AddCalendar2(s,Entry);
+ }
+ }
+ if (error != ERR_NONE) return error;
+
+ error=N6510_GetCalendarInfo3(s, &Priv->LastCalendar,0);
+ memcpy(&LastCalendar2,&Priv->LastCalendar,sizeof(GSM_NOKIACalToDoLocations));
+ if (error != ERR_NONE) return error;
+
+ smprintf(s,"Number of entries: %i %i\n",LastCalendar1.Number,LastCalendar2.Number);
+
+ for(i=0;i<LastCalendar2.Number;i++) {
+ found = TRUE;
+ for(j=0;j<LastCalendar1.Number;j++) {
+ if (LastCalendar1.Location[j] == LastCalendar2.Location[i]) {
+ found = FALSE;
+ break;
+ }
+ }
+ if (found) {
+ Note.Location = LastCalendar2.Location[i];
+ error=N6510_PrivGetCalendar3(s, &Note, TRUE, &LastCalendarYear);
+ if (error != ERR_NONE) return error;
+
+ error=N71_65_DelCalendar(s, &Note);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Ending finding note ID\n");
+
+ for(j=0;j<Priv->CalendarIconsNum;j++) {
+ if (Priv->CalendarIconsTypes[j] == Entry->Type) {
+ *ID = Priv->CalendarIcons[j];
+ return ERR_NONE;
+ }
+ }
+ return ERR_UNKNOWN;
+ }
+ }
+
+ return ERR_UNKNOWN;
+}
+
+/* method 3 */
+GSM_Error N6510_ReplyAddCalendar3(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Calendar note added\n");
+ return ERR_NONE;
+}
+
+/* method 3 */
+static GSM_Error N6510_AddCalendar3(GSM_StateMachine *s, GSM_CalendarEntry *Note, int *FirstCalendarPos)
+{
+ GSM_CalendarNoteType NoteType, OldNoteType;
+ time_t t_time1,t_time2;
+ long diff;
+ GSM_Error error;
+ GSM_DateTime DT,date_time;
+ int Text, Time, Alarm, Phone, EndTime, Location, count=54;
+ unsigned char req[5000] = {
+ N6110_FRAME_HEADER, 0x65,
+ 0x00, /* 0 = calendar, 1 = todo */
+ 0x00, 0x00, 0x00,
+ 0x00, 0x00, /* location */
+ 0x00, 0x00, 0x00, 0x00,
+ 0xFF, 0xFF, 0xFF, 0xFF, /* alarm */
+ 0x80, 0x00, 0x00,
+ 0x01, /* note icon */
+ 0xFF, 0xFF, 0xFF, 0xFF, /* alarm type */
+ 0x00, /* 0x02 or 0x00 */
+ 0x01, /* note type */
+ 0x07, 0xD0, 0x01, 0x12, 0x0C, 0x00, /* start date/time */
+ 0x07, 0xD0, 0x01, 0x12, 0x0C, 0x00, /* end date/time */
+ 0x00, 0x00, /* recurrance */
+ 0x00, 0x00, /* birth year */
+ 0x20, /* ToDo priority */
+ 0x00, /* ToDo completed ? */
+ 0x00, 0x00, /* How many times repeat cal note or 0 */
+ 0x00,
+ 0x00, /* note text length */
+ 0x00, /* phone length/meeting place */
+ 0x00, 0x00, 0x00};
+
+ error=N6510_GetCalendarNotePos3(s);
+ if (error!=ERR_NONE) return error;
+ Note->Location = *FirstCalendarPos;
+ req[8] = *FirstCalendarPos/256;
+ req[9] = *FirstCalendarPos%256;
+
+ NoteType = N71_65_FindCalendarType(Note->Type, s->Phone.Data.ModelInfo);
+
+ switch(NoteType) {
+ case GSM_CAL_REMINDER : req[27]=0x00; req[26]=0x02; break;
+ case GSM_CAL_MEETING : req[27]=0x01; break;
+ case GSM_CAL_CALL : req[27]=0x02; break;
+ case GSM_CAL_BIRTHDAY : req[27]=0x04; break;
+ case GSM_CAL_MEMO : req[27]=0x08; break;
+ default : return ERR_UNKNOWN;
+ }
+
+ OldNoteType = Note->Type;
+ Note->Type = NoteType;
+ error=N6510_FindCalendarIconID3(s, Note, &req[21]);
+ Note->Type = OldNoteType;
+ if (error!=ERR_NONE) return error;
+
+ GSM_CalendarFindDefaultTextTimeAlarmPhone(Note, &Text, &Time, &Alarm, &Phone, &EndTime, &Location);
+
+ if (Time == -1) {
+ smprintf(s,"No time!\n");
+ return ERR_UNKNOWN;
+ }
+ smprintf(s, "Time OK\n");
+ memcpy(&DT,&Note->Entries[Time].Date,sizeof(GSM_DateTime));
+ req[28] = DT.Year / 256;
+ req[29] = DT.Year % 256;
+ req[30] = DT.Month;
+ req[31] = DT.Day;
+ req[32] = DT.Hour;
+ req[33] = DT.Minute;
+
+ if (NoteType == GSM_CAL_BIRTHDAY) {
+ error=s->Phone.Functions->GetDateTime(s,&date_time);
+ switch (error) {
+ case ERR_EMPTY:
+ case ERR_NOTIMPLEMENTED:
+ GSM_GetCurrentDateTime(&date_time);
+ break;
+ case ERR_NONE:
+ break;
+ default:
+ return error;
+ }
+ req[28] = date_time.Year / 256;
+ req[29] = date_time.Year % 256;
+ if (DT.Year == 0) {
+ req[42] = 0xff;
+ req[43] = 0xff;
+ } else {
+ req[42] = DT.Year / 256;
+ req[43] = DT.Year % 256;
+ }
+ }
+
+ if (EndTime != -1) memcpy(&DT,&Note->Entries[EndTime].Date,sizeof(GSM_DateTime));
+
+ req[34] = DT.Year / 256;
+ req[35] = DT.Year % 256;
+ req[36] = DT.Month;
+ req[37] = DT.Day;
+ req[38] = DT.Hour;
+ req[39] = DT.Minute;
+ if (NoteType == GSM_CAL_BIRTHDAY) {
+ req[34] = date_time.Year / 256;
+ req[35] = date_time.Year % 256;
+ }
+
+ GSM_SetCalendarRecurranceRepeat(&(s->di), req+40, req+52, Note);
+
+ if (Alarm != -1) {
+ memcpy(&DT,&Note->Entries[Time].Date,sizeof(GSM_DateTime));
+ if (Note->Entries[Alarm].EntryType == CAL_SILENT_ALARM_DATETIME) {
+ req[22] = 0x00; req[23] = 0x00; req[24] = 0x00; req[25] = 0x00;
+ }
+ if (NoteType == GSM_CAL_BIRTHDAY) DT.Year = date_time.Year;
+ t_time2 = Fill_Time_T(DT);
+ t_time1 = Fill_Time_T(Note->Entries[Alarm].Date);
+ diff = (t_time1-t_time2)/60;
+
+ smprintf(s, " Difference : %li seconds or minutes\n", -diff);
+ req[14] = (unsigned char)(-diff >> 24);
+ req[15] = (unsigned char)(-diff >> 16);
+ req[16] = (unsigned char)(-diff >> 8);
+ req[17] = (unsigned char)(-diff);
+ }
+
+ if (Text != -1) {
+ req[48] = UnicodeLength(Note->Entries[Text].Text) / 256;
+ req[49] = UnicodeLength(Note->Entries[Text].Text) % 256;
+ CopyUnicodeString(req + 54, Note->Entries[Text].Text);
+ count += req[49] * 2 + (req[48] * 256) * 2;
+ }
+
+ if (Phone != -1 && NoteType == GSM_CAL_CALL) {
+ req[50] = UnicodeLength(Note->Entries[Phone].Text);
+ CopyUnicodeString(req+54+req[49]*2,Note->Entries[Phone].Text);
+ count+= req[50]*2;
+ }
+
+ if (Location != -1 && NoteType == GSM_CAL_MEETING) {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL62) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL65) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL35)) {
+ } else {
+ req[50] = UnicodeLength(Note->Entries[Location].Text);
+ CopyUnicodeString(req+54+req[49]*2,Note->Entries[Location].Text);
+ count+= req[50]*2;
+ }
+ }
+
+ req[count++] = 0x00;
+
+ smprintf(s, "Writing calendar note method 3\n");
+ return GSM_WaitFor (s, req, count, 0x13, 4, ID_SetCalendarNote);
+}
+
+GSM_Error N6510_GetNextCalendar(GSM_StateMachine *s, GSM_CalendarEntry *Note, gboolean start)
+{
+#ifdef GSM_FORCE_DCT4_CALENDAR_6210
+ /* Method 1. Some features missed. Not working with some notes in 3510 */
+ return N71_65_GetNextCalendar1(s,Note,start,&s->Phone.Data.Priv.N6510.LastCalendar,&s->Phone.Data.Priv.N6510.LastCalendarYear,&s->Phone.Data.Priv.N6510.LastCalendarPos);
+#endif
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL62)) {
+ /* Method 1. Some features missed. Not working with some notes in 3510 */
+ return N71_65_GetNextCalendar1(s,Note,start,&s->Phone.Data.Priv.N6510.LastCalendar,&s->Phone.Data.Priv.N6510.LastCalendarYear,&s->Phone.Data.Priv.N6510.LastCalendarPos);
+
+ /* Method 2. In known phones texts of notes cut to 50 chars. Some features missed */
+/* return N71_65_GetNextCalendar2(s,Note,start,&s->Phone.Data.Priv.N6510.LastCalendarYear,&s->Phone.Data.Priv.N6510.LastCalendarPos); */
+ } else {
+ /* Method 3. All DCT4 features supported. Not supported by 8910 */
+ return N6510_GetNextCalendar3(s,Note,start,&s->Phone.Data.Priv.N6510.LastCalendar,&s->Phone.Data.Priv.N6510.LastCalendarYear,&s->Phone.Data.Priv.N6510.LastCalendarPos);
+ }
+}
+
+GSM_Error N6510_GetCalendarStatus(GSM_StateMachine *s, GSM_CalendarStatus *Status)
+{
+ GSM_Error error;
+
+#ifdef GSM_FORCE_DCT4_CALENDAR_6210
+ /* Method 1 */
+ error=N71_65_GetCalendarInfo1(s, &s->Phone.Data.Priv.N6510.LastCalendar);
+ if (error!=ERR_NONE) return error;
+ Status->Used = s->Phone.Data.Priv.N6510.LastCalendar.Number;
+ return ERR_NONE;
+#endif
+
+ /**
+ * @todo This should be acquired from phone
+ */
+ Status->Free = 100;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL62)) {
+ /* Method 1 */
+ error=N71_65_GetCalendarInfo1(s, &s->Phone.Data.Priv.N6510.LastCalendar);
+ if (error!=ERR_NONE) return error;
+ Status->Used = s->Phone.Data.Priv.N6510.LastCalendar.Number;
+ return ERR_NONE;
+
+ /* Method 2 */
+/* return ERR_NOTSUPPORTED; */
+ } else {
+ /* Method 3 */
+ error=N6510_GetCalendarInfo3(s,&s->Phone.Data.Priv.N6510.LastCalendar,0);
+ if (error!=ERR_NONE) return error;
+ Status->Used = s->Phone.Data.Priv.N6510.LastCalendar.Number;
+ return ERR_NONE;
+ }
+}
+
+GSM_Error N6510_AddCalendar(GSM_StateMachine *s, GSM_CalendarEntry *Note)
+{
+#ifdef GSM_FORCE_DCT4_CALENDAR_6210
+ return N71_65_AddCalendar2(s,Note);
+#endif
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CAL62)) {
+ return N71_65_AddCalendar2(s,Note);
+/* return N71_65_AddCalendar1(s, Note, &s->Phone.Data.Priv.N6510.FirstCalendarPos); */
+ } else {
+ /* Method 3. All DCT4 features supported. Not supported by 8910 */
+ return N6510_AddCalendar3(s, Note, &s->Phone.Data.Priv.N6510.FirstCalendarPos);
+ }
+}
+
+GSM_Error N6510_ReplyGetNoteInfo(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ return N6510_ReplyGetCalendarInfo3(msg, s, &s->Phone.Data.Priv.N6510.LastNote);
+}
+
+GSM_Error N6510_ReplyGetNote(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int len;
+
+ smprintf(s, "Note received\n");
+ len = msg->Buffer[50] * 256 + msg->Buffer[51];
+ if (len > GSM_MAX_NOTE_TEXT_LENGTH) {
+ smprintf(s, "Note too long (%d), truncating to %d\n", len, GSM_MAX_NOTE_TEXT_LENGTH);
+ len = GSM_MAX_NOTE_TEXT_LENGTH;
+ }
+ memcpy(s->Phone.Data.Note->Text,
+ msg->Buffer + 54,
+ len * 2);
+ s->Phone.Data.Note->Text[len * 2] = 0;
+ s->Phone.Data.Note->Text[(len * 2) + 1] = 0;
+ return ERR_NONE;
+}
+
+GSM_Error N6510_GetNextNote(GSM_StateMachine *s, GSM_NoteEntry *Note, gboolean start)
+{
+ GSM_Error error;
+ GSM_NOKIACalToDoLocations *LastNote = &s->Phone.Data.Priv.N6510.LastNote;
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOTES)) return ERR_NOTSUPPORTED;
+
+ if (start) {
+ error=N6510_GetCalendarInfo3(s,LastNote,2);
+ if (error!=ERR_NONE) return error;
+ Note->Location = 1;
+ } else {
+ Note->Location++;
+ }
+
+ if (Note->Location > LastNote->Number) return ERR_EMPTY;
+
+ s->Phone.Data.Note = Note;
+ smprintf(s, "Getting note\n");
+ return N6510_PrivGetGenericCalendar3(s, LastNote->Location[Note->Location-1], ID_GetNote);
+}
+
+GSM_Error N6510_DeleteNote(GSM_StateMachine *s, GSM_NoteEntry *Not)
+{
+ GSM_Error error;
+ GSM_NOKIACalToDoLocations *LastNote = &s->Phone.Data.Priv.N6510.LastNote;
+ GSM_CalendarEntry Note;
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOTES)) return ERR_NOTSUPPORTED;
+
+ error=N6510_GetCalendarInfo3(s,LastNote,2);
+ if (error!=ERR_NONE) return error;
+
+ smprintf(s, "Deleting Note\n");
+
+ if (Not->Location > LastNote->Number || Not->Location == 0) return ERR_INVALIDLOCATION;
+
+ Note.Location = LastNote->Location[Not->Location-1];
+ return N71_65_DelCalendar(s,&Note);
+}
+
+GSM_Error N6510_ReplyGetNoteFirstLoc(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "First Note location: %i\n",msg->Buffer[8]*256+msg->Buffer[9]);
+ s->Phone.Data.Note->Location = msg->Buffer[8]*256+msg->Buffer[9];
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplyAddNote(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Note added\n");
+ return ERR_NONE;
+}
+
+GSM_Error N6510_AddNote(GSM_StateMachine *s, GSM_NoteEntry *Not)
+{
+ GSM_Error error;
+ int count=54;
+ unsigned char reqLoc[] = {N6110_FRAME_HEADER, 0x95,
+ 0x02}; /* 1 = todo, 2 = note */
+ unsigned char req[GSM_MAX_NOTE_TEXT_LENGTH + 500] = {
+ N6110_FRAME_HEADER, 0x65,
+ 0x02, /* 0 = calendar, 1 = todo, 2 = note */
+ 0x00, 0x00, 0x00,
+ 0x00, 0x00, /* location */
+ 0x00, 0x00, 0x00, 0x00,
+ 0xFF, 0xFF, 0xFF, 0xFF, /* alarm */
+ 0x80, 0x00, 0x00,
+ 0xA9, /* note icon */
+ 0x00, 0x00, 0x00, 0x00, /* alarm type */
+ 0x00, /* 0x02 or 0x00 */
+ 0x80, /* note type */
+ 0x07, 0xD2, 0x01, 0x01, 0x00, 0x00, /* start date/time */
+ 0x07, 0xD2, 0x01, 0x11, 0x00, 0x00, /* end date/time */
+ 0x00, 0x00, /* recurrance */
+ 0xFF, 0xFF, /* birth year */
+ 0x00, /* ToDo priority */
+ 0x00, /* ToDo completed ? */
+ 0x00, 0x00, 0x00,
+ 0x00, /* note text length */
+ 0x00, /* phone length/meeting place */
+ 0x00, 0x00, 0x00};
+ size_t length;
+
+ s->Phone.Data.Note = Not;
+
+ smprintf(s, "Getting first free Note location\n");
+ error = GSM_WaitFor (s, reqLoc, 5, 0x13, 4, ID_SetNote);
+ if (error!=ERR_NONE) return error;
+ req[8] = Not->Location / 256;
+ req[9] = Not->Location % 256;
+
+ length = UnicodeLength(Not->Text);
+ req[48] = length / 256;
+ req[49] = length % 256;
+ CopyUnicodeString(req + 54, Not->Text);
+ count += length * 2;
+
+ req[count++] = 0x00;
+
+ smprintf(s, "Adding Note\n");
+ return GSM_WaitFor (s, req, count, 0x13, 4, ID_SetNote);
+}
+
+GSM_Error N6510_GetNoteStatus(GSM_StateMachine *s, GSM_ToDoStatus *status)
+{
+ GSM_NOKIACalToDoLocations *LastNote = &s->Phone.Data.Priv.N6510.LastNote;
+ GSM_Error error;
+
+ error = N6510_GetCalendarInfo3(s,LastNote,2);
+ if (error!=ERR_NONE) return error;
+
+ status->Used = LastNote->Number;
+ return ERR_NONE;
+}
+
+/* ToDo support - 6310 style */
+GSM_Error N6510_ReplyGetToDoStatus1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int i;
+ GSM_NOKIACalToDoLocations *Last = &s->Phone.Data.Priv.N6510.LastToDo;
+
+ smprintf(s, "TODO locations received\n");
+ Last->Number=msg->Buffer[6]*256+msg->Buffer[7];
+ smprintf(s, "Number of Entries: %i\n",Last->Number);
+ smprintf(s, "Locations: ");
+ for (i=0;i<Last->Number;i++) {
+ Last->Location[i]=msg->Buffer[12+(i*4)]*256+msg->Buffer[(i*4)+13];
+ smprintf(s, "%i ",Last->Location[i]);
+ }
+ smprintf(s, "\n");
+ return ERR_NONE;
+}
+
+/* ToDo support - 6310 style */
+static GSM_Error N6510_GetToDoStatus1(GSM_StateMachine *s, GSM_ToDoStatus *status)
+{
+ GSM_Error error;
+ GSM_NOKIACalToDoLocations *LastToDo = &s->Phone.Data.Priv.N6510.LastToDo;
+ unsigned char reqLoc[] = {
+ N6110_FRAME_HEADER,
+ 0x15, 0x01, 0x00, 0x00,
+ 0x00, 0x00, 0x00};
+
+ smprintf(s, "Getting ToDo locations\n");
+ error = GSM_WaitFor (s, reqLoc, 10, 0x55, 4, ID_GetToDo);
+ if (error != ERR_NONE) return error;
+
+ status->Used = LastToDo->Number;
+ /**
+ * @todo This should be acquired from phone
+ */
+ status->Free = 100;
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetToDoStatus2(GSM_StateMachine *s, GSM_ToDoStatus *status)
+{
+ GSM_NOKIACalToDoLocations *LastToDo = &s->Phone.Data.Priv.N6510.LastToDo;
+ GSM_Error error;
+
+ error = N6510_GetCalendarInfo3(s,LastToDo,1);
+ if (error!=ERR_NONE) return error;
+
+ status->Used = LastToDo->Number;
+ /**
+ * @todo This should be acquired from phone
+ */
+ status->Free = 100;
+ return ERR_NONE;
+}
+
+GSM_Error N6510_GetToDoStatus(GSM_StateMachine *s, GSM_ToDoStatus *status)
+{
+ status->Used = 0;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO63)) {
+ return N6510_GetToDoStatus1(s, status);
+ } else if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO66)) {
+ return N6510_GetToDoStatus2(s, status);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+}
+
+/* ToDo support - 6310 style */
+GSM_Error N6510_ReplyGetToDo1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_ToDoEntry *Last = s->Phone.Data.ToDo;
+
+ smprintf(s, "TODO received method 1\n");
+
+ /**
+ * @todo There might be better type.
+ */
+ Last->Type = GSM_CAL_MEMO;
+
+ switch (msg->Buffer[4]) {
+ case 1 : Last->Priority = GSM_Priority_High; break;
+ case 2 : Last->Priority = GSM_Priority_Medium; break;
+ case 3 : Last->Priority = GSM_Priority_Low; break;
+ default : return ERR_UNKNOWN;
+ }
+ smprintf(s, "Priority: %i\n",msg->Buffer[4]);
+
+ CopyUnicodeString(Last->Entries[0].Text,msg->Buffer+14);
+ Last->Entries[0].EntryType = TODO_TEXT;
+ Last->EntriesNum = 1;
+ smprintf(s, "Text: \"%s\"\n",DecodeUnicodeString(Last->Entries[0].Text));
+
+ return ERR_NONE;
+}
+
+/* ToDo support - 6310 style */
+static GSM_Error N6510_GetNextToDo1(GSM_StateMachine *s, GSM_ToDoEntry *ToDo, gboolean refresh)
+{
+ GSM_Error error;
+ GSM_ToDoStatus status;
+ GSM_NOKIACalToDoLocations *LastToDo = &s->Phone.Data.Priv.N6510.LastToDo;
+ unsigned char reqGet[] = {
+ N6110_FRAME_HEADER,
+ 0x03, 0x00, 0x00, 0x80, 0x00,
+ 0x00, 0x17}; /* Location */
+
+ if (refresh) {
+ error = N6510_GetToDoStatus(s, &status);
+ if (error != ERR_NONE) return error;
+ ToDo->Location = 1;
+ } else {
+ ToDo->Location++;
+ }
+ if (ToDo->Location > LastToDo->Number) return ERR_EMPTY;
+
+ reqGet[8] = LastToDo->Location[ToDo->Location-1] / 256;
+ reqGet[9] = LastToDo->Location[ToDo->Location-1] % 256;
+ s->Phone.Data.ToDo = ToDo;
+ smprintf(s, "Getting ToDo\n");
+ return GSM_WaitFor (s, reqGet, 10, 0x55, 4, ID_GetToDo);
+}
+
+GSM_Error N6510_ReplyGetToDoStatus2(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ return N6510_ReplyGetCalendarInfo3(msg, s, &s->Phone.Data.Priv.N6510.LastToDo);
+}
+
+/* Similiar to getting calendar method 3 */
+GSM_Error N6510_ReplyGetToDo2(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_ToDoEntry *Last = s->Phone.Data.ToDo;
+ GSM_DateTime Date;
+ unsigned long diff;
+ int len;
+
+ smprintf(s, "ToDo received method 2\n");
+
+ /**
+ * @todo There might be better type.
+ */
+ Last->Type = GSM_CAL_MEMO;
+
+ switch (msg->Buffer[44]) {
+ case 0x10: Last->Priority = GSM_Priority_Low; break;
+ case 0x20: Last->Priority = GSM_Priority_Medium; break;
+ case 0x30: Last->Priority = GSM_Priority_High; break;
+ default : return ERR_UNKNOWN;
+ }
+
+ len = msg->Buffer[50] * 256 + msg->Buffer[51];
+ if (len > GSM_MAX_TODO_TEXT_LENGTH) {
+ smprintf(s, "Todo text too long (%d), truncating to %d\n", len, GSM_MAX_TODO_TEXT_LENGTH);
+ len = GSM_MAX_TODO_TEXT_LENGTH;
+ }
+ memcpy(Last->Entries[0].Text,
+ msg->Buffer + 54,
+ len * 2);
+ Last->Entries[0].Text[len * 2] = 0;
+ Last->Entries[0].Text[(len * 2) + 1] = 0;
+ Last->Entries[0].EntryType = TODO_TEXT;
+ smprintf(s, "Text: \"%s\"\n",DecodeUnicodeString(Last->Entries[0].Text));
+
+ smprintf(s,"EndTime: %04i-%02i-%02i %02i:%02i\n",
+ msg->Buffer[34]*256+msg->Buffer[35],
+ msg->Buffer[36],msg->Buffer[37],msg->Buffer[38],
+ msg->Buffer[39]);
+ Date.Year = msg->Buffer[34]*256+msg->Buffer[35];
+ Date.Month = msg->Buffer[36];
+ Date.Day = msg->Buffer[37];
+ Date.Hour = msg->Buffer[38];
+ Date.Minute = msg->Buffer[39];
+ Date.Second = 0;
+ Date.Timezone = 0;
+ Last->Entries[1].EntryType = TODO_END_DATETIME;
+ memcpy(&Last->Entries[1].Date, &Date, sizeof(GSM_DateTime));
+
+ smprintf(s,"StartTime: %04i-%02i-%02i %02i:%02i\n",
+ msg->Buffer[28]*256+msg->Buffer[29],
+ msg->Buffer[30],msg->Buffer[31],msg->Buffer[32],
+ msg->Buffer[33]);
+ Date.Year = msg->Buffer[28]*256+msg->Buffer[29];
+ Date.Month = msg->Buffer[30];
+ Date.Day = msg->Buffer[31];
+ Date.Hour = msg->Buffer[32];
+ Date.Minute = msg->Buffer[33];
+ Date.Second = 0;
+ Date.Timezone = 0;
+
+ Last->EntriesNum = 2;
+
+ if (msg->Buffer[45] == 0x01) {
+ Last->Entries[2].Number = msg->Buffer[45];
+ Last->Entries[2].EntryType = TODO_COMPLETED;
+ Last->EntriesNum++;
+ smprintf(s,"Completed\n");
+ }
+
+ if (msg->Buffer[14] == 0xFF && msg->Buffer[15] == 0xFF && msg->Buffer[16] == 0xff && msg->Buffer[17] == 0xff) {
+ smprintf(s, "No alarm\n");
+ } else {
+ diff = ((unsigned int)msg->Buffer[14]) << 24;
+ diff += ((unsigned int)msg->Buffer[15]) << 16;
+ diff += ((unsigned int)msg->Buffer[16]) << 8;
+ diff += msg->Buffer[17];
+
+ memcpy(&Last->Entries[Last->EntriesNum].Date,&Date,sizeof(GSM_DateTime));
+ GetTimeDifference(diff, &Last->Entries[Last->EntriesNum].Date, FALSE, 60);
+ smprintf(s, "Alarm date : %02i-%02i-%04i %02i:%02i:%02i\n",
+ Last->Entries[Last->EntriesNum].Date.Day, Last->Entries[Last->EntriesNum].Date.Month,
+ Last->Entries[Last->EntriesNum].Date.Year, Last->Entries[Last->EntriesNum].Date.Hour,
+ Last->Entries[Last->EntriesNum].Date.Minute,Last->Entries[Last->EntriesNum].Date.Second);
+
+ Last->Entries[Last->EntriesNum].EntryType = TODO_ALARM_DATETIME;
+ if (msg->Buffer[22]==0x00 && msg->Buffer[23]==0x00 &&
+ msg->Buffer[24]==0x00 && msg->Buffer[25]==0x00)
+ {
+ Last->Entries[Last->EntriesNum].EntryType = TODO_SILENT_ALARM_DATETIME;
+ smprintf(s, "Alarm type : Silent\n");
+ }
+ Last->EntriesNum++;
+ }
+
+ return ERR_NONE;
+}
+
+/* ToDo support - 6610 style */
+static GSM_Error N6510_GetNextToDo2(GSM_StateMachine *s, GSM_ToDoEntry *ToDo, gboolean refresh)
+{
+ GSM_Error error;
+ GSM_NOKIACalToDoLocations *LastToDo = &s->Phone.Data.Priv.N6510.LastToDo;
+
+ if (refresh) {
+ error=N6510_GetCalendarInfo3(s,LastToDo,1);
+ if (error!=ERR_NONE) return error;
+ ToDo->Location = 1;
+ } else {
+ ToDo->Location++;
+ }
+
+ if (ToDo->Location > LastToDo->Number) return ERR_EMPTY;
+
+ s->Phone.Data.ToDo = ToDo;
+ smprintf(s, "Getting todo method 2\n");
+ return N6510_PrivGetGenericCalendar3(s, LastToDo->Location[ToDo->Location-1], ID_GetToDo);
+}
+
+GSM_Error N6510_GetNextToDo(GSM_StateMachine *s, GSM_ToDoEntry *ToDo, gboolean refresh)
+{
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO63)) {
+ return N6510_GetNextToDo1(s, ToDo, refresh);
+ } else if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO66)) {
+ return N6510_GetNextToDo2(s, ToDo, refresh);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+}
+
+/* ToDo support - 6310 style */
+GSM_Error N6510_ReplyDeleteAllToDo1(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "All TODO deleted\n");
+ return ERR_NONE;
+}
+
+/* ToDo support - 6310 style */
+GSM_Error N6510_DeleteAllToDo1(GSM_StateMachine *s)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x11};
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO63)) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ smprintf(s, "Deleting all ToDo method 1\n");
+ return GSM_WaitFor (s, req, 4, 0x55, 4, ID_DeleteAllToDo);
+}
+
+GSM_Error N6510_DeleteToDo2(GSM_StateMachine *s, GSM_ToDoEntry *ToDo)
+{
+ GSM_Error error;
+ GSM_NOKIACalToDoLocations *LastToDo = &s->Phone.Data.Priv.N6510.LastToDo;
+ GSM_CalendarEntry Note;
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO66)) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ error=N6510_GetCalendarInfo3(s,LastToDo,1);
+ if (error!=ERR_NONE) return error;
+
+ smprintf(s, "Deleting ToDo method 2\n");
+
+ if (ToDo->Location > LastToDo->Number || ToDo->Location == 0) return ERR_INVALIDLOCATION;
+
+ Note.Location = LastToDo->Location[ToDo->Location-1];
+ return N71_65_DelCalendar(s,&Note);
+}
+
+/* ToDo support - 6310 style */
+GSM_Error N6510_ReplyGetToDoFirstLoc1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "TODO first location received method 1: %02x\n",msg->Buffer[9]);
+ s->Phone.Data.ToDo->Location = msg->Buffer[9];
+ return ERR_NONE;
+}
+
+/* ToDo support - 6310 style */
+GSM_Error N6510_ReplyAddToDo1(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "TODO set OK\n");
+ return ERR_NONE;
+}
+
+/* ToDo support - 6310 style */
+static GSM_Error N6510_AddToDo1(GSM_StateMachine *s, GSM_ToDoEntry *ToDo)
+{
+ int Text, Alarm, EndTime, Completed, ulen, Phone;
+ GSM_Error error;
+ unsigned char reqLoc[] = {N6110_FRAME_HEADER, 0x0F};
+ unsigned char reqSet[500] = {
+ N6110_FRAME_HEADER, 0x01,
+ 0x03, /* Priority */
+ 0x00, /* Length of text */
+ 0x80,0x00,0x00,
+ 0x18}; /* Location */
+
+ s->Phone.Data.ToDo = ToDo;
+
+ smprintf(s, "Getting first ToDo location\n");
+ error = GSM_WaitFor (s, reqLoc, 4, 0x55, 4, ID_SetToDo);
+ if (error != ERR_NONE) return error;
+ reqSet[9] = ToDo->Location;
+
+ switch (ToDo->Priority) {
+ case GSM_Priority_Low : reqSet[4] = 3; break;
+ case GSM_Priority_Medium: reqSet[4] = 2; break;
+ case GSM_Priority_High : reqSet[4] = 1; break;
+ default: break;
+ }
+
+ GSM_ToDoFindDefaultTextTimeAlarmCompleted(ToDo, &Text, &Alarm, &Completed, &EndTime, &Phone);
+
+ if (Text == -1) return ERR_NOTSUPPORTED; /* XXX: shouldn't this be handled different way? */
+ ulen = UnicodeLength(ToDo->Entries[Text].Text);
+ reqSet[5] = ulen+1;
+ CopyUnicodeString(reqSet+10,ToDo->Entries[Text].Text);
+ reqSet[10+ulen*2] = 0x00;
+ reqSet[10+ulen*2+1] = 0x00;
+ smprintf(s, "Adding ToDo method 1\n");
+ return GSM_WaitFor (s, reqSet, 12+ulen*2, 0x55, 4, ID_SetToDo);
+}
+
+GSM_Error N6510_ReplyAddToDo2(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "ToDo added method 2\n");
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplyGetToDoFirstLoc2(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "First ToDo location method 2: %i\n",msg->Buffer[8]*256+msg->Buffer[9]);
+ s->Phone.Data.ToDo->Location = msg->Buffer[8]*256+msg->Buffer[9];
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_AddToDo2(GSM_StateMachine *s, GSM_ToDoEntry *ToDo)
+{
+ GSM_CalendarEntry Note;
+ time_t t_time1,t_time2;
+ long diff;
+ GSM_Error error;
+ GSM_DateTime DT;
+ int Text, Alarm, EndTime, Completed, count=54, Phone;
+ unsigned char reqLoc[] = {N6110_FRAME_HEADER, 0x95,
+ 0x01}; /* 1 = todo, 2 = note */
+ unsigned char req[GSM_MAX_TODO_TEXT_LENGTH + 500] = {
+ N6110_FRAME_HEADER, 0x65,
+ 0x01, /* 0 = calendar, 1 = todo */
+ 0x00, 0x00, 0x00,
+ 0x00, 0x00, /* location */
+ 0x00, 0x00, 0x00, 0x00,
+ 0xFF, 0xFF, 0xFF, 0xFF, /* alarm */
+ 0x80, 0x00, 0x00,
+ 0x01, /* note icon */
+ 0xFF, 0xFF, 0xFF, 0xFF, /* alarm type */
+ 0x00, /* 0x02 or 0x00 */
+ 0x01, /* note type */
+ 0x07, 0xD0, 0x01, 0x12, 0x0C, 0x00, /* start date/time */
+ 0x07, 0xD0, 0x01, 0x12, 0x0C, 0x00, /* end date/time */
+ 0x00, 0x00, /* recurrance */
+ 0x00, 0x00, /* birth year */
+ 0x20, /* ToDo priority */
+ 0x00, /* ToDo completed ? */
+ 0x00, 0x00, /* How many times repeat cal note or 0 */
+ 0x00,
+ 0x00, /* note text length */
+ 0x00, /* phone length/meeting place */
+ 0x00, 0x00, 0x00};
+
+ s->Phone.Data.ToDo = ToDo;
+
+ smprintf(s, "Getting first free ToDo location method 2\n");
+ error = GSM_WaitFor (s, reqLoc, 5, 0x13, 4, ID_SetToDo);
+ if (error!=ERR_NONE) return error;
+ req[8] = ToDo->Location/256;
+ req[9] = ToDo->Location%256;
+
+ Note.Type = GSM_CAL_MEETING;
+ DT.Year = 2004; DT.Month = 1; DT.Day = 1;
+ DT.Hour = 12; DT.Minute = 12; DT.Second = 0;
+ DT.Timezone = 0;
+ memcpy(&Note.Entries[0].Date,&DT,sizeof(GSM_DateTime));
+ Note.Entries[0].EntryType = CAL_START_DATETIME;
+ memcpy(&Note.Entries[1].Date,&DT,sizeof(GSM_DateTime));
+ Note.Entries[1].EntryType = CAL_END_DATETIME;
+ EncodeUnicode(Note.Entries[2].Text,"ala",3);
+ Note.Entries[2].EntryType = CAL_TEXT;
+ Note.EntriesNum = 3;
+ error=N6510_FindCalendarIconID3(s, &Note, &req[21]);
+ if (error!=ERR_NONE) return error;
+
+ switch (ToDo->Priority) {
+ case GSM_Priority_Low : req[44] = 0x10; break;
+ case GSM_Priority_Medium: req[44] = 0x20; break;
+ case GSM_Priority_High : req[44] = 0x30; break;
+ default: break;
+ }
+
+ GSM_ToDoFindDefaultTextTimeAlarmCompleted(ToDo, &Text, &Alarm, &Completed, &EndTime, &Phone);
+
+ if (Completed != -1) req[45] = 0x01;
+
+ if (EndTime == -1) {
+ GSM_GetCurrentDateTime(&DT);
+ } else {
+ memcpy(&DT,&ToDo->Entries[EndTime].Date,sizeof(GSM_DateTime));
+ }
+ /*Start time*/
+ req[28] = DT.Year / 256;
+ req[29] = DT.Year % 256;
+ req[30] = DT.Month;
+ req[31] = DT.Day;
+ req[32] = DT.Hour;
+ req[33] = DT.Minute;
+ /*End time*/
+ req[34] = DT.Year / 256;
+ req[35] = DT.Year % 256;
+ req[36] = DT.Month;
+ req[37] = DT.Day;
+ req[38] = DT.Hour;
+ req[39] = DT.Minute;
+
+ if (Alarm != -1) {
+ if (ToDo->Entries[Alarm].EntryType == TODO_SILENT_ALARM_DATETIME)
+ {
+ req[22] = 0x00; req[23] = 0x00; req[24] = 0x00; req[25] = 0x00;
+ }
+ t_time2 = Fill_Time_T(DT);
+ t_time1 = Fill_Time_T(ToDo->Entries[Alarm].Date);
+ diff = (t_time1-t_time2)/60;
+
+ smprintf(s, " Difference : %li seconds or minutes\n", -diff);
+ req[14] = (unsigned char)(-diff >> 24);
+ req[15] = (unsigned char)(-diff >> 16);
+ req[16] = (unsigned char)(-diff >> 8);
+ req[17] = (unsigned char)(-diff);
+ }
+
+ if (Text != -1) {
+ req[48] = UnicodeLength(ToDo->Entries[Text].Text) / 256;
+ req[49] = UnicodeLength(ToDo->Entries[Text].Text) % 256;
+ CopyUnicodeString(req + 54, ToDo->Entries[Text].Text);
+ count += req[49] * 2 + (req[48] * 256) * 2;
+ }
+
+ req[count++] = 0x00;
+
+ smprintf(s, "Adding ToDo method 2\n");
+ return GSM_WaitFor (s, req, count, 0x13, 4, ID_SetToDo);
+}
+
+GSM_Error N6510_AddToDo(GSM_StateMachine *s, GSM_ToDoEntry *ToDo)
+{
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO63)) {
+ return N6510_AddToDo1(s, ToDo);
+ } else if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_TODO66)) {
+ return N6510_AddToDo2(s, ToDo);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+}
+
+GSM_Error N6510_ReplyGetCalendarSettings(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_CalendarSettings *sett = s->Phone.Data.CalendarSettings;
+
+ switch (msg->Buffer[3]) {
+ case 0x86:
+ smprintf(s, "Auto deleting setting received\n");
+ sett->AutoDelete = msg->Buffer[4];
+ return ERR_NONE;
+ case 0x8E:
+ smprintf(s, "Start day for calendar received\n");
+ switch(msg->Buffer[4]) {
+ case 0x04:
+ sett->StartDay = 1;
+ return ERR_NONE;
+ case 0x03:
+ sett->StartDay = 6;
+ return ERR_NONE;
+ case 0x02:
+ sett->StartDay = 7;
+ return ERR_NONE;
+ case 0x01:
+ sett->StartDay = 1;
+ return ERR_NONE;
+ }
+ break;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+GSM_Error N6510_GetCalendarSettings(GSM_StateMachine *s, GSM_CalendarSettings *settings)
+{
+ GSM_Error error;
+ unsigned char req1[] = {N6110_FRAME_HEADER, 0x85};
+ unsigned char req2[] = {N6110_FRAME_HEADER, 0x8D};
+
+ s->Phone.Data.CalendarSettings = settings;
+
+ smprintf(s, "Getting auto delete\n");
+ error = GSM_WaitFor (s, req1, 4, 0x13, 4, ID_GetCalendarSettings);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Getting start day for week\n");
+ return GSM_WaitFor (s, req2, 4, 0x13, 4, ID_GetCalendarSettings);
+}
+
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */
diff --git a/libgammu/phone/nokia/dct4s40/6510/6510cal.h b/libgammu/phone/nokia/dct4s40/6510/6510cal.h
new file mode 100644
index 0000000..da09ffa
--- /dev/null
+++ b/libgammu/phone/nokia/dct4s40/6510/6510cal.h
@@ -0,0 +1,51 @@
+
+/* calendar */
+
+GSM_Error N6510_ReplyGetCalendarInfo(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetCalendar3(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_GetNextCalendar(GSM_StateMachine *s, GSM_CalendarEntry *Note, gboolean start);
+
+GSM_Error N6510_ReplyGetCalendarNotePos(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddCalendar3(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_AddCalendar(GSM_StateMachine *s, GSM_CalendarEntry *Note);
+
+GSM_Error N6510_GetCalendarStatus(GSM_StateMachine *s, GSM_CalendarStatus *Status);
+
+/* notes */
+
+GSM_Error N6510_ReplyGetNoteInfo(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetNote(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_GetNextNote(GSM_StateMachine *s, GSM_NoteEntry *Note, gboolean start);
+
+GSM_Error N6510_DeleteNote(GSM_StateMachine *s, GSM_NoteEntry *Not);
+
+GSM_Error N6510_ReplyGetNoteFirstLoc(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddNote(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_AddNote(GSM_StateMachine *s, GSM_NoteEntry *Not);
+
+GSM_Error N6510_GetNoteStatus(GSM_StateMachine *s, GSM_ToDoStatus *status);
+
+/* todo */
+
+GSM_Error N6510_ReplyGetToDoStatus2(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetToDoStatus1(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_GetToDoStatus(GSM_StateMachine *s, GSM_ToDoStatus *status);
+
+GSM_Error N6510_ReplyGetToDo1(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetToDo2(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_GetNextToDo(GSM_StateMachine *s, GSM_ToDoEntry *ToDo, gboolean refresh);
+
+GSM_Error N6510_ReplyDeleteAllToDo1(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_DeleteAllToDo1(GSM_StateMachine *s);
+GSM_Error N6510_DeleteToDo2(GSM_StateMachine *s, GSM_ToDoEntry *ToDo);
+
+GSM_Error N6510_ReplyGetToDoFirstLoc1(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetToDoFirstLoc2(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddToDo1(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddToDo2(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_AddToDo(GSM_StateMachine *s, GSM_ToDoEntry *ToDo);
+
+/* calendar settings */
+
+GSM_Error N6510_ReplyGetCalendarSettings(GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_GetCalendarSettings(GSM_StateMachine *s, GSM_CalendarSettings *settings);
diff --git a/libgammu/phone/nokia/dct4s40/6510/6510file.c b/libgammu/phone/nokia/dct4s40/6510/6510file.c
new file mode 100644
index 0000000..952c69c
--- /dev/null
+++ b/libgammu/phone/nokia/dct4s40/6510/6510file.c
@@ -0,0 +1,2609 @@
+/* (c) 2003-2006 by Marcin Wiacek */
+/* function for making CRC for filesystem (c) 2003 by Michael Schroeder */
+
+#include <gammu-config.h>
+
+#ifdef GSM_ENABLE_NOKIA6510
+
+#include <string.h>
+#include <time.h>
+
+#include "../../../../misc/coding/coding.h"
+#include "../../../../gsmcomon.h"
+#include "../../../../service/gsmlogo.h"
+#include "../../nfunc.h"
+#include "../../nfuncold.h"
+#include "../../../pfunc.h"
+#include "../dct4func.h"
+#include "n6510.h"
+#include "../../../../../libgammu/misc/string.h"
+
+/* shared */
+
+/**
+ * Shifts data in file cache by defined count.
+ *
+ * \param move How to move entries. +10 means that i entry will become
+ * i + 10, while -10 means that entries will be moved backwards. Of
+ * course starting at the beginning of the list. So 10 entry will become 0.
+ */
+static GSM_Error N6510_ShiftFileCache(GSM_StateMachine *s, int move)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int i;
+
+ if (move < 0) {
+ for (i = 0; i < Priv->FilesLocationsUsed + move; i++) {
+ memcpy(&Priv->FilesCache[i], &Priv->FilesCache[i - move], sizeof(GSM_File));
+ smprintf(s, "Copying %i to %i\n", i - move, i);
+ }
+ } else {
+ for (i = Priv->FilesLocationsUsed - 1; i >= 0; i--) {
+ memcpy(&Priv->FilesCache[i + move], &Priv->FilesCache[i], sizeof(GSM_File));
+ smprintf(s, "Copying %i to %i\n", i, i + move);
+ }
+ }
+
+ Priv->FilesLocationsUsed += move;
+
+ return ERR_NONE;
+}
+/**
+ * Allocates enough entries in file cache.
+ *
+ * \param requested Number of files which are requested.
+ */
+static GSM_Error N6510_AllocFileCache(GSM_StateMachine *s, int requested)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int newsize;
+
+ /* Maybe there is already enough allocated */
+ if (Priv->FilesLocationsAvail >= requested) return ERR_NONE;
+
+ /* Do not allocate one by one */
+ newsize = requested + 10;
+
+ /* Reallocate memory */
+ Priv->FilesCache = (GSM_File *)realloc(Priv->FilesCache, newsize * sizeof(GSM_File));
+ if (Priv->FilesCache == NULL) return ERR_MOREMEMORY;
+
+ /* Store new cache size */
+ Priv->FilesLocationsAvail = newsize;
+
+ return ERR_NONE;
+}
+
+static int N6510_FindFileCheckSum12(GSM_StateMachine *s, unsigned char *ptr, int len)
+{
+ int acc, i, accx;
+
+ accx = 0;
+ acc = 0xffff;
+ while (len--) {
+ accx = (accx & 0xffff00ff) | (acc & 0xff00);
+ acc = (acc & 0xffff00ff) | (*ptr++ << 8);
+ for (i = 0; i < 8; i++) {
+ acc <<= 1;
+ if (acc & 0x10000) acc ^= 0x1021;
+ if (accx & 0x80000000) acc ^= 0x1021;
+ accx <<= 1;
+ }
+ }
+ smprintf(s, "Checksum from Gammu is %04X\n",(acc & 0xffff));
+ return (acc & 0xffff);
+}
+
+GSM_Error N6510_ReplyGetFilePart12(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int old;
+
+ smprintf(s,"File part received\n");
+ old = s->Phone.Data.File->Used;
+ s->Phone.Data.File->Used += msg->Buffer[6]*256*256*256+
+ msg->Buffer[7]*256*256+
+ msg->Buffer[8]*256+
+ msg->Buffer[9];
+ smprintf(s,"Length of file part: %i\n",
+ msg->Buffer[6]*256*256*256+
+ msg->Buffer[7]*256*256+
+ msg->Buffer[8]*256+
+ msg->Buffer[9]);
+ s->Phone.Data.File->Buffer = (unsigned char *)realloc(s->Phone.Data.File->Buffer,s->Phone.Data.File->Used);
+ memcpy(s->Phone.Data.File->Buffer+old,msg->Buffer+10,s->Phone.Data.File->Used-old);
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplyGetFileCRC12(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+
+ Priv->FileCheckSum = msg->Buffer[6] * 256 + msg->Buffer[7];
+ smprintf(s,"File checksum from phone is %04X\n",Priv->FileCheckSum);
+ return ERR_NONE;
+}
+
+/* filesystem 1 */
+
+static GSM_Error N6510_GetFileCRC1(GSM_StateMachine *s, unsigned char *id)
+{
+ unsigned char GetCRC[] = {
+ N7110_FRAME_HEADER, 0x42, 0x00, 0x00, 0x00, 0x01,
+ 0x00, 0x1E}; /* file ID */
+
+ GetCRC[8] = atoi(DecodeUnicodeString(id)) / 256;
+ GetCRC[9] = atoi(DecodeUnicodeString(id)) % 256;
+ smprintf(s,"Getting CRC for file in filesystem\n");
+ return GSM_WaitFor (s, GetCRC, 10, 0x6D, 4, ID_GetCRC);
+}
+
+GSM_Error N6510_ReplyGetFileFolderInfo1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_File *File = s->Phone.Data.FileInfo;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int i, newsize;
+ unsigned char buffer[500];
+ GSM_Error error;
+
+ switch (msg->Buffer[3]) {
+ case 0x15:
+ smprintf(s,"File or folder details received\n");
+ CopyUnicodeString(File->Name,msg->Buffer+10);
+ if (msg->Length == 14) {
+ smprintf(s,"File not exist\n");
+ return ERR_FILENOTEXIST;
+ }
+ if (!strncmp(DecodeUnicodeString(File->Name),"GMSTemp",7)) return ERR_EMPTY;
+ if (File->Name[0] == 0x00 && File->Name[1] == 0x00) return ERR_UNKNOWN;
+
+/* EncodeHexUnicode (buffer, File->Name, UnicodeLength(File->Name)); */
+/* smprintf(s,"Name encoded: %s\n",buffer); */
+
+ i = msg->Buffer[8]*256+msg->Buffer[9];
+ smprintf(s, "%02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
+ msg->Buffer[i-5],msg->Buffer[i-4],msg->Buffer[i-3],
+ msg->Buffer[i-2],msg->Buffer[i-1],msg->Buffer[i],
+ msg->Buffer[i+1],msg->Buffer[i+2],msg->Buffer[i+3]);
+
+ File->Folder = FALSE;
+ if (msg->Buffer[i-5] == 0x00 && msg->Buffer[i-3]==0x02) File->Folder = TRUE;
+
+ File->ReadOnly = FALSE;
+ File->Protected = FALSE;
+ File->System = FALSE;
+ File->Hidden = FALSE;
+ if (msg->Buffer[i+2] == 0x01) File->Protected = TRUE;
+ if (msg->Buffer[i+4] == 0x01) File->ReadOnly = TRUE;
+ if (msg->Buffer[i+5] == 0x01) File->Hidden = TRUE;
+ if (msg->Buffer[i+6] == 0x01) File->System = TRUE;/* fixme */
+
+ File->ModifiedEmpty = FALSE;
+ NOKIA_DecodeDateTime(s, msg->Buffer+i-22, &File->Modified, TRUE, FALSE);
+ if (File->Modified.Year == 0x00) File->ModifiedEmpty = TRUE;
+ if (File->Modified.Year == 0xffff) File->ModifiedEmpty = TRUE;
+ smprintf(s, "%02x %02x %02x %02x\n",msg->Buffer[i-22],msg->Buffer[i-21],msg->Buffer[i-20],msg->Buffer[i-19]);
+
+ Priv->FileToken = msg->Buffer[i-10]*256+msg->Buffer[i-9];
+ Priv->ParentID = msg->Buffer[i]*256+msg->Buffer[i+1];
+ smprintf(s,"ParentID is %i\n",Priv->ParentID);
+
+ File->Type = GSM_File_Other;
+ if (msg->Length > 240){
+ i = 227;
+ if (msg->Buffer[i]==0x02 && msg->Buffer[i+2]==0x01)
+ File->Type = GSM_File_Image_JPG;
+ else if (msg->Buffer[i]==0x02 && msg->Buffer[i+2]==0x02)
+ File->Type = GSM_File_Image_BMP;
+ else if (msg->Buffer[i]==0x02 && msg->Buffer[i+2]==0x07)
+ File->Type = GSM_File_Image_BMP;
+ else if (msg->Buffer[i]==0x02 && msg->Buffer[i+2]==0x03)
+ File->Type = GSM_File_Image_PNG;
+ else if (msg->Buffer[i]==0x02 && msg->Buffer[i+2]==0x05)
+ File->Type = GSM_File_Image_GIF;
+ else if (msg->Buffer[i]==0x02 && msg->Buffer[i+2]==0x09)
+ File->Type = GSM_File_Image_WBMP;
+ else if (msg->Buffer[i]==0x04 && msg->Buffer[i+2]==0x01)
+ File->Type = GSM_File_Sound_AMR;
+ else if (msg->Buffer[i]==0x04 && msg->Buffer[i+2]==0x02)
+ File->Type = GSM_File_Sound_MIDI;
+ else if (msg->Buffer[i]==0x08 && msg->Buffer[i+2]==0x05)
+ File->Type = GSM_File_Video_3GP;
+ else if (msg->Buffer[i]==0x10 && msg->Buffer[i+2]==0x01)
+ File->Type = GSM_File_Java_JAR;
+ else if (msg->Buffer[i]==0x00 && msg->Buffer[i+2]==0x01)
+ File->Type = GSM_File_MMS;
+ }
+ return ERR_NONE;
+ case 0x2F:
+ smprintf(s,"File or folder used bytes received\n");
+ File->Used = msg->Buffer[6]*256*256*256+
+ msg->Buffer[7]*256*256+
+ msg->Buffer[8]*256+
+ msg->Buffer[9];
+ return ERR_NONE;
+ case 0x33:
+ if (s->Phone.Data.RequestID == ID_GetFileInfo) {
+
+ newsize = msg->Buffer[8] * 256 + msg->Buffer[9];
+
+ error = N6510_AllocFileCache(s, Priv->FilesLocationsUsed + newsize);
+ if (error != ERR_NONE) return error;
+
+ error = N6510_ShiftFileCache(s, newsize);
+ if (error != ERR_NONE) return error;
+
+ for (i = 0; i < newsize; i++) {
+ sprintf(buffer,"%i",msg->Buffer[13+i*4-1]*256 + msg->Buffer[13+i*4]);
+ EncodeUnicode(Priv->FilesCache[i].ID_FullName,buffer,strlen(buffer));
+ Priv->FilesCache[i].Level = File->Level+1;
+ smprintf(s, "%s ",DecodeUnicodeString(Priv->FilesCache[i].ID_FullName));
+ }
+ smprintf(s, "\n");
+ }
+ if ((msg->Buffer[8]*256+msg->Buffer[9]) != 0x00) File->Folder = TRUE;
+ return ERR_NONE;
+ case 0xf0:
+ smprintf(s, "File system is not supported\n");
+ return ERR_NOTSUPPORTED;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetFileFolderInfo1(GSM_StateMachine *s, GSM_File *File, gboolean full)
+{
+ GSM_Error error;
+ unsigned char req[10] = {
+ N7110_FRAME_HEADER,
+ 0x14, /* 0x14 - info, 0x22 - free/total, 0x2E - used, 0x32 - sublocations */
+ 0x01, /* 0x00 for sublocations reverse sorting, 0x01 for free */
+ 0x00, 0x00, 0x01,
+ 0x00, 0x01}; /* Folder or file number */
+
+ s->Phone.Data.FileInfo = File;
+ req[8] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ req[9] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+
+ req[3] = 0x14;
+ req[4] = 0x01;
+ smprintf(s,"Getting info for file in filesystem\n");
+ error=GSM_WaitFor (s, req, 10, 0x6D, 4, ID_GetFileInfo);
+ if (error != ERR_NONE) return error;
+
+ if (full) {
+ req[3] = 0x32;
+ req[4] = 0x00;
+ smprintf(s,"Getting subfolders for filesystem\n");
+ error=GSM_WaitFor (s, req, 10, 0x6D, 4, ID_GetFileInfo);
+ if (error != ERR_NONE) return error;
+ }
+
+ if (!File->Folder) {
+ req[3] = 0x2E;
+ req[4] = 0x01;
+ smprintf(s,"Getting used memory for file in filesystem\n");
+ return GSM_WaitFor (s, req, 10, 0x6D, 4, ID_GetFileInfo);
+ }
+
+ return error;
+}
+
+static GSM_Error N6510_GetNextFileFolder1(GSM_StateMachine *s, GSM_File *File, gboolean start)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_Error error;
+ unsigned char buffer[5];
+
+ if (start) {
+ error = N6510_AllocFileCache(s, 1);
+ if (error != ERR_NONE) return error;
+
+ Priv->FilesLocationsUsed = 1;
+
+ sprintf(buffer,"%i",0x01);
+ EncodeUnicode(Priv->FilesCache[0].ID_FullName,buffer,strlen(buffer));
+ Priv->FilesCache[0].Level = 1;
+ }
+
+ while (1) {
+ if (Priv->FilesLocationsUsed == 0) return ERR_EMPTY;
+
+ CopyUnicodeString(File->ID_FullName,Priv->FilesCache[0].ID_FullName);
+ File->Level = Priv->FilesCache[0].Level;
+
+ error = N6510_ShiftFileCache(s, -1);
+ if (error != ERR_NONE) return error;
+
+ error = N6510_GetFileFolderInfo1(s, File, TRUE);
+ if (error == ERR_EMPTY) continue;
+ return error;
+ }
+}
+
+GSM_Error N6510_ReplyGetFileSystemStatus1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[3]) {
+ case 0x23:
+ if (!strcmp(s->Phone.Data.ModelInfo->model,"6310i")) {
+ smprintf(s,"File or folder total bytes received\n");
+ s->Phone.Data.FileSystemStatus->Free =
+ 3*256*256 + msg->Buffer[8]*256 + msg->Buffer[9] -
+ s->Phone.Data.FileSystemStatus->Used;
+ } else {
+ smprintf(s,"File or folder free bytes received\n");
+ s->Phone.Data.FileSystemStatus->Free =
+ msg->Buffer[6]*256*256*256+
+ msg->Buffer[7]*256*256+
+ msg->Buffer[8]*256+
+ msg->Buffer[9];
+ }
+ return ERR_NONE;
+ case 0x2F:
+ smprintf(s,"File or folder used bytes received\n");
+ s->Phone.Data.FileSystemStatus->Used =
+ msg->Buffer[6]*256*256*256+
+ msg->Buffer[7]*256*256+
+ msg->Buffer[8]*256+
+ msg->Buffer[9];
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetFileSystemStatus1(GSM_StateMachine *s, GSM_FileSystemStatus *status)
+{
+ GSM_Error error;
+ unsigned char req[10] = {
+ N7110_FRAME_HEADER,
+ 0x22, /* 0x14 - info, 0x22 - free/total, 0x2E - used, 0x32 - sublocations */
+ 0x01, /* 0x00 for sublocations reverse sorting, 0x01 for free */
+ 0x00, 0x00, 0x01,
+ 0x00, 0x01}; /* Folder or file number */
+
+ /* Used memory by types */
+ status->UsedImages = 0;
+ status->UsedSounds = 0;
+ status->UsedThemes = 0;
+ s->Phone.Data.FileSystemStatus = status;
+
+ status->Free = 0;
+
+ req[3] = 0x2E;
+ req[4] = 0x01;
+ smprintf(s, "Getting used/total memory in filesystem\n");
+ error = GSM_WaitFor (s, req, 10, 0x6D, 4, ID_FileSystemStatus);
+ if (error != ERR_NONE) return error;
+
+ req[3] = 0x22;
+ req[4] = 0x01;
+ smprintf(s, "Getting free memory in filesystem\n");
+ return GSM_WaitFor (s, req, 10, 0x6D, 4, ID_FileSystemStatus);
+}
+
+static GSM_Error N6510_GetFilePart1(GSM_StateMachine *s, GSM_File *File, int *Handle UNUSED, size_t *Size)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int old;
+ GSM_Error error;
+ unsigned char req[] = {
+ N7110_FRAME_HEADER, 0x0E, 0x00, 0x00, 0x00, 0x01,
+ 0x00, 0x01, /* Folder or file number */
+ 0x00, 0x00, 0x00, 0x00, /* Start from xxx byte */
+ 0x00, 0x00,
+ 0x03, 0xE8}; /* Read xxx bytes */
+
+ if (File->Used == 0x00) {
+ error = N6510_GetFileFolderInfo1(s, File, FALSE);
+ if (error != ERR_NONE) return error;
+
+ if (File->Folder) return ERR_SHOULDBEFILE;
+
+ (*Size) = File->Used;
+ File->Used = 0;
+ }
+
+ old = File->Used;
+ req[8] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ req[9] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+ req[10] = old / (256*256*256);
+ req[11] = old / (256*256);
+ req[12] = old / 256;
+ req[13] = old % 256;
+
+ s->Phone.Data.File = File;
+ smprintf(s, "Getting file part from filesystem\n");
+ error=GSM_WaitFor (s, req, 18, 0x6D, 4, ID_GetFile);
+ if (error != ERR_NONE) return error;
+ if (File->Used - old != (0x03 * 256 + 0xE8)) {
+ error = N6510_GetFileCRC1(s, File->ID_FullName);
+ if (error != ERR_NONE) return error;
+
+ if (N6510_FindFileCheckSum12(s, File->Buffer, File->Used) != Priv->FileCheckSum) {
+ smprintf(s,"File2 checksum is %i, File checksum is %i\n",N6510_FindFileCheckSum12(s, File->Buffer, File->Used),Priv->FileCheckSum);
+ return ERR_WRONGCRC;
+ }
+ return ERR_EMPTY;
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_SetReadOnly1(GSM_StateMachine *s, unsigned char *ID, gboolean enable)
+{
+ unsigned char SetAttr[] = {
+ N7110_FRAME_HEADER, 0x18,
+ 0x00, /* state */
+ 0x00, 0x00, 0x01,
+ 0x00, 0x20}; /* File ID */
+
+ if (!enable) SetAttr[4] = 0x06;
+
+ SetAttr[8] = atoi(DecodeUnicodeString(ID)) / 256;
+ SetAttr[9] = atoi(DecodeUnicodeString(ID)) % 256;
+ smprintf(s, "Setting readonly attribute\n");
+ return GSM_WaitFor (s, SetAttr, 10, 0x6D, 4, ID_SetAttrib);
+}
+
+static GSM_Error N6510_SetFileAttributes1(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_Error error;
+ GSM_File file2;
+
+ memset(&file2, 0, sizeof(file2));
+
+ CopyUnicodeString(file2.ID_FullName,File->ID_FullName);
+ error = N6510_GetFileFolderInfo1(s, &file2, FALSE);
+ if (error != ERR_NONE) return error;
+
+ /* setting folder attrib works, but we block it */
+ if (file2.Folder) return ERR_SHOULDBEFILE;
+
+ /* todo */
+ if (file2.System != File->System ||
+ file2.Hidden != File->Hidden ||
+ file2.Protected != File->Protected) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ return N6510_SetReadOnly1(s, File->ID_FullName, File->ReadOnly);
+}
+
+/* function checks if there is file/folder with searched name in folder with specified ID */
+static GSM_Error N6510_SearchForFileName1(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_Error error;
+ GSM_File *BackupCache, *NewFiles;
+ int FilesLocationsUsed,FilesLocationsUsed2,i;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+
+ File->Folder = FALSE;
+
+ /* making backup */
+ BackupCache = (GSM_File *)malloc(sizeof(GSM_File) * Priv->FilesLocationsUsed);
+ if (BackupCache == NULL) return ERR_MOREMEMORY;
+ memcpy(BackupCache, Priv->FilesCache, sizeof(GSM_File) * Priv->FilesLocationsUsed);
+ FilesLocationsUsed = Priv->FilesLocationsUsed;
+
+ /* Allocate new cache */
+ error = N6510_AllocFileCache(s, 1);
+ if (error != ERR_NONE) {
+ free(BackupCache);
+ return error;
+ }
+
+ /* putting own data */
+ Priv->FilesCache[0].Level = 1;
+ Priv->FilesLocationsUsed = 1;
+ CopyUnicodeString(Priv->FilesCache[0].ID_FullName,File->ID_FullName);
+
+ /* checking */
+ error = N6510_GetFileFolderInfo1(s, &Priv->FilesCache[0], TRUE);
+
+ /* backuping new data */
+ NewFiles = (GSM_File *)malloc(sizeof(GSM_File) * Priv->FilesLocationsUsed);
+ if (NewFiles == NULL) {
+ free(BackupCache);
+ BackupCache=NULL;
+ return ERR_MOREMEMORY;
+ }
+ memcpy(NewFiles, Priv->FilesCache, sizeof(GSM_File) * Priv->FilesLocationsUsed);
+ FilesLocationsUsed2 = Priv->FilesLocationsUsed;
+
+ /* restoring */
+ memcpy(Priv->FilesCache, BackupCache, sizeof(GSM_File) * FilesLocationsUsed);
+ free(BackupCache);
+ BackupCache=NULL;
+ Priv->FilesLocationsUsed = FilesLocationsUsed;
+
+ if (error != ERR_NONE) {
+ free(NewFiles);
+ NewFiles=NULL;
+ return error;
+ }
+
+ for (i = 0; i < FilesLocationsUsed2; i++) {
+ smprintf(s, "ID is %s\n",DecodeUnicodeString(NewFiles[i].ID_FullName));
+ error = N6510_GetFileFolderInfo1(s, &NewFiles[i], FALSE);
+ if (error == ERR_EMPTY) continue;
+ if (error != ERR_NONE) {
+ free(NewFiles);
+ NewFiles=NULL;
+ return error;
+ }
+ smprintf(s, "%s",DecodeUnicodeString(File->Name));
+ smprintf(s, "%s \n",DecodeUnicodeString(NewFiles[i].Name));
+ if (mywstrncasecmp(NewFiles[i].Name,File->Name,0)) {
+ smprintf(s, "the same\n");
+ File->Folder = NewFiles[i].Folder;
+ free(NewFiles);
+ NewFiles=NULL;
+ return ERR_NONE;
+ }
+ }
+ free(NewFiles);
+ NewFiles=NULL;
+ return ERR_EMPTY;
+}
+
+GSM_Error N6510_ReplyAddFileHeader1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ unsigned char buffer[5];
+
+ switch (msg->Buffer[3]) {
+ case 0x03:
+ smprintf(s,"File header added\n");
+ sprintf(buffer,"%i",msg->Buffer[8]*256+msg->Buffer[9]);
+ EncodeUnicode(s->Phone.Data.File->ID_FullName,buffer,strlen(buffer));
+ return ERR_NONE;
+ case 0x13:
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+GSM_Error N6510_ReplyAddFilePart1(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s UNUSED)
+{
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_AddFilePart1(GSM_StateMachine *s, GSM_File *File, size_t *Pos, int *Handle UNUSED)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_File File2;
+ GSM_Error error;
+ int j;
+ unsigned char Header[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER, 0x02, 0x00, 0x00, 0x00, 0x01,
+ 0x00, 0x0C, /* parent folder ID */
+ 0x00, 0x00, 0x00, 0xE8};
+ unsigned char Add[15000] = {
+ N7110_FRAME_HEADER, 0x40, 0x00, 0x00, 0x00, 0x01,
+ 0x00, 0x04, /* file ID */
+ 0x00, 0x00,
+ 0x01, 0x28}; /* length */
+ unsigned char end[30] = {
+ N7110_FRAME_HEADER, 0x40, 0x00, 0x00, 0x00, 0x01,
+ 0x00, 0x04, /* file ID */
+ 0x00, 0x00, 0x00, 0x00};
+
+ memset(&File2, 0, sizeof(File2));
+
+ s->Phone.Data.File = File;
+
+ if (*Pos == 0) {
+ error = N6510_SearchForFileName1(s,File);
+ if (error == ERR_NONE) return ERR_FILEALREADYEXIST;
+ if (error != ERR_EMPTY) return error;
+
+ Header[8] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ Header[9] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+ memset(Header+14, 0x00, 300);
+ CopyUnicodeString(Header+14,File->Name);
+ Header[222] = File->Used / (256*256*256);
+ Header[223] = File->Used / (256*256);
+ Header[224] = File->Used / 256;
+ Header[225] = File->Used % 256;
+ switch(File->Type) {
+ case GSM_File_Image_JPG : Header[231]=0x02; Header[233]=0x01; break;
+ case GSM_File_Image_BMP : Header[231]=0x02; Header[233]=0x02; break;
+ case GSM_File_Image_PNG : Header[231]=0x02; Header[233]=0x03; break;
+ case GSM_File_Image_GIF : Header[231]=0x02; Header[233]=0x05; break;
+ case GSM_File_Image_WBMP : Header[231]=0x02; Header[233]=0x09; break;
+ case GSM_File_Sound_AMR : Header[231]=0x04; Header[233]=0x01; break;
+ case GSM_File_Sound_MIDI : Header[231]=0x04; Header[233]=0x05; break; /* Header[238]=0x01; */
+ case GSM_File_Sound_NRT : Header[231]=0x04; Header[233]=0x06; break;
+ case GSM_File_Video_3GP : Header[231]=0x08; Header[233]=0x05; break;
+ case GSM_File_Java_JAR : Header[231]=0x10; Header[233]=0x01; break;
+ case GSM_File_MMS:
+ Header[214]=0x07;
+ Header[215]=0xd3;
+ Header[216]=0x06;
+ Header[217]=0x01;
+ Header[218]=0x12;
+ Header[219]=0x13;
+ Header[220]=0x29;
+ Header[233]=0x01;
+ break;
+ default : Header[231]=0x01; Header[233]=0x05;
+ }
+ Header[235] = 0x01;
+ Header[236] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ Header[237] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+ if (File->Protected) Header[238] = 0x01; /* Nokia forward lock */
+ if (File->Hidden) Header[241] = 0x01;
+ if (File->System) Header[242] = 0x01; /* fixme */
+ smprintf(s, "Adding file header\n");
+ error=GSM_WaitFor (s, Header, 246, 0x6D, 4, ID_AddFile);
+ if (error != ERR_NONE) return error;
+ }
+
+ j = 1000;
+ if (File->Used - *Pos < 1000) j = File->Used - *Pos;
+ Add[ 8] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ Add[ 9] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+ Add[12] = j / 256;
+ Add[13] = j % 256;
+ memcpy(Add+14,File->Buffer+(*Pos),j);
+ smprintf(s, "Adding file part %ld %i\n", (long)*Pos,j);
+ error=GSM_WaitFor (s, Add, 14+j, 0x6D, 4, ID_AddFile);
+ if (error != ERR_NONE) return error;
+ *Pos = *Pos + j;
+
+ if (j < 1000) {
+ /* FIXME: This looks strange */
+ end[8] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ end[9] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+ smprintf(s, "Frame for ending adding file\n");
+ error = GSM_WaitFor (s, end, 14, 0x6D, 4, ID_AddFile);
+ if (error != ERR_NONE) return error;
+
+ CopyUnicodeString(File2.ID_FullName,File->ID_FullName);
+ error = N6510_GetFileFolderInfo1(s, &File2, FALSE);
+ if (error != ERR_NONE) return error;
+
+ if (!File->ModifiedEmpty) {
+ Header[3] = 0x12;
+ Header[4] = 0x01;
+ Header[12] = 0x00;
+ Header[13] = 0xE8;
+ Header[8] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ Header[9] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+ memset(Header+14, 0x00, 300);
+ CopyUnicodeString(Header+14,File->Name);
+ NOKIA_EncodeDateTime(s,Header+214,&File->Modified);
+ /* When you save too big file for phone and it changes
+ * size (some part is cut by firmware), you HAVE to write
+ * here correct file size. In other case filesystem
+ * will be damaged
+ */
+ Header[224] = File2.Used / 256;
+ Header[225] = File2.Used % 256;
+ Header[226] = Priv->FileToken / 256;
+ Header[227] = Priv->FileToken % 256;
+ switch(File->Type) {
+ case GSM_File_Image_JPG : Header[231]=0x02; Header[233]=0x01; break;
+ case GSM_File_Image_BMP : Header[231]=0x02; Header[233]=0x02; break;
+ case GSM_File_Image_PNG : Header[231]=0x02; Header[233]=0x03; break;
+ case GSM_File_Image_GIF : Header[231]=0x02; Header[233]=0x05; break;
+ case GSM_File_Image_WBMP : Header[231]=0x02; Header[233]=0x09; break;
+ case GSM_File_Sound_AMR : Header[231]=0x04; Header[233]=0x01; break;
+ case GSM_File_Sound_MIDI : Header[231]=0x04; Header[233]=0x05; break; /* Header[238]=0x01; */
+ case GSM_File_Sound_NRT : Header[231]=0x04; Header[233]=0x06; break;
+ case GSM_File_Video_3GP : Header[231]=0x08; Header[233]=0x05; break;
+ case GSM_File_Java_JAR : Header[231]=0x10; Header[233]=0x01; break;
+ case GSM_File_MMS:
+ Header[214]=0x07;
+ Header[215]=0xd3;
+ Header[216]=0x06;
+ Header[217]=0x01;
+ Header[218]=0x12;
+ Header[219]=0x13;
+ Header[220]=0x29;
+ Header[233]=0x01;
+ break;
+ default : Header[231]=0x01; Header[233]=0x05;
+ }
+ Header[235] = 0x01;
+ Header[236] = Priv->ParentID / 256;
+ Header[237] = Priv->ParentID % 256;
+ smprintf(s, "Adding file header\n");
+ error=GSM_WaitFor (s, Header, 246, 0x6D, 4, ID_AddFile);
+ if (error != ERR_NONE) return error;
+ }
+
+ /* Can't delete from phone menu */
+ if (File->ReadOnly) {
+ error = N6510_SetReadOnly1(s, File->ID_FullName, TRUE);
+ if (error != ERR_NONE) return error;
+ }
+
+ error = N6510_GetFileCRC1(s, File->ID_FullName);
+ if (error != ERR_NONE) return error;
+
+ if (N6510_FindFileCheckSum12(s, File->Buffer, File->Used) != Priv->FileCheckSum) {
+ smprintf(s,"File2 checksum is %i, File checksum is %i\n",N6510_FindFileCheckSum12(s, File->Buffer, File->Used),Priv->FileCheckSum);
+ return ERR_WRONGCRC;
+ }
+
+ return ERR_EMPTY;
+ }
+
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplyDeleteFileFolder1(GSM_Protocol_Message *msg, GSM_StateMachine *s UNUSED)
+{
+ if (msg->Buffer[4] == 0x01) {
+ return ERR_NONE;
+ } else if (msg->Buffer[4] == 0x04) {
+ return ERR_FILENOTEXIST;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_PrivDeleteFileFolder1(GSM_StateMachine *s, unsigned char *ID, gboolean file)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_File File;
+ GSM_Error error;
+ unsigned char Delete[40] = {
+ N7110_FRAME_HEADER, 0x1E, 0x00, 0x00, 0x00, 0x01,
+ 0x00, 0x35}; /* File ID */
+
+ memset(&File, 0, sizeof(File));
+
+ Priv->FilesLocationsUsed = 0;
+ CopyUnicodeString(File.ID_FullName,ID);
+ error = N6510_GetFileFolderInfo1(s, &File, TRUE);
+ if (error != ERR_NONE) return error;
+ if (file) {
+ if (File.Folder) return ERR_SHOULDBEFILE;
+ } else {
+ if (!File.Folder) return ERR_SHOULDBEFOLDER;
+ /* dont allow to delete non empty folder */
+ if (Priv->FilesLocationsUsed != 0) return ERR_FOLDERNOTEMPTY;
+ }
+
+ error = N6510_SetReadOnly1(s, ID, FALSE);
+ if (error != ERR_NONE) return error;
+
+ /* FIXME: This looks wrong */
+ Delete[8] = atoi(DecodeUnicodeString(ID)) / 256;
+ Delete[9] = atoi(DecodeUnicodeString(ID)) % 256;
+
+ return GSM_WaitFor (s, Delete, 10, 0x6D, 4, ID_DeleteFile);
+}
+
+static GSM_Error N6510_DeleteFile1(GSM_StateMachine *s, unsigned char *ID)
+{
+ return N6510_PrivDeleteFileFolder1(s,ID,TRUE);
+}
+
+static GSM_Error N6510_DeleteFolder1(GSM_StateMachine *s, unsigned char *ID)
+{
+ return N6510_PrivDeleteFileFolder1(s,ID,FALSE);
+}
+
+GSM_Error N6510_ReplyAddFolder1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ unsigned char buffer[5];
+
+ sprintf(buffer,"%i",msg->Buffer[8]*256+msg->Buffer[9]);
+ EncodeUnicode(s->Phone.Data.File->ID_FullName,buffer,strlen(buffer));
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_AddFolder1(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_File File2;
+ GSM_Error error;
+ unsigned char Header[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER, 0x04, 0x00, 0x00, 0x00, 0x01,
+ 0x00, 0x0C, /* parent folder ID */
+ 0x00, 0x00, 0x00, 0xE8};
+
+ memset(&File2, 0, sizeof(File2));
+
+ CopyUnicodeString(File2.ID_FullName,File->ID_FullName);
+ error = N6510_GetFileFolderInfo1(s, &File2, FALSE);
+ if (error != ERR_NONE) return error;
+ if (!File2.Folder) return ERR_SHOULDBEFOLDER;
+
+ Header[8] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ Header[9] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+ memset(Header+14, 0x00, 300);
+ CopyUnicodeString(Header+14,File->Name);
+ Header[233] = 0x02;
+ Header[235] = 0x01;
+ Header[236] = atoi(DecodeUnicodeString(File->ID_FullName)) / 256;
+ Header[237] = atoi(DecodeUnicodeString(File->ID_FullName)) % 256;
+
+ s->Phone.Data.File = File;
+ smprintf(s, "Adding folder\n");
+ error = GSM_WaitFor (s, Header, 246, 0x6D, 4, ID_AddFolder);
+ if (error != ERR_NONE) return error;
+
+ if (!strcmp(DecodeUnicodeString(File->ID_FullName),"0")) return ERR_FILEALREADYEXIST;
+
+ /* Can't delete from phone menu */
+ if (File->ReadOnly) {
+ error = N6510_SetReadOnly1(s, File->ID_FullName, TRUE);
+ if (error != ERR_NONE) return error;
+ }
+
+ return error;
+}
+
+static GSM_Error N6510_GetFolderListing1(GSM_StateMachine *s, GSM_File *File, gboolean start)
+{
+ GSM_Error error;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+
+ if (start) {
+ Priv->FilesLocationsUsed = 0;
+
+ error = N6510_GetFileFolderInfo1(s, File, TRUE);
+ if (error != ERR_NONE) return error;
+
+ if (!File->Folder) return ERR_SHOULDBEFOLDER;
+ }
+
+ while (TRUE) {
+ if (Priv->FilesLocationsUsed == 0) return ERR_EMPTY;
+
+ memcpy(File,&Priv->FilesCache[0],sizeof(GSM_File));
+ error = N6510_GetFileFolderInfo1(s, File, FALSE);
+ if (error != ERR_NONE) return error;
+
+ error = N6510_ShiftFileCache(s, -1);
+ if (error != ERR_NONE) return error;
+
+ break;
+ }
+ return error;
+}
+
+/* filesystem 2 */
+
+GSM_Error N6510_ReplyOpenFile2(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ if (msg->Buffer[4]==0) {
+ smprintf(s,"File opened and handle received\n");
+ s->Phone.Data.FileHandle = msg->Buffer[6]*256*256*256+
+ msg->Buffer[7]*256*256+
+ msg->Buffer[8]*256+
+ msg->Buffer[9];
+ smprintf(s,"File handle: %i\n",
+ msg->Buffer[6]*256*256*256+
+ msg->Buffer[7]*256*256+
+ msg->Buffer[8]*256+
+ msg->Buffer[9]);
+ return ERR_NONE;
+ } else if (msg->Buffer[4] == 0x03) {
+ smprintf(s,"You can't open already existing folder\n");
+ return ERR_FILEALREADYEXIST;
+ } else if (msg->Buffer[4] == 0x06) {
+ smprintf(s,"File not exist\n");
+ return ERR_FILENOTEXIST;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_OpenFile2(GSM_StateMachine *s, char *Name, int *Handle, gboolean Create)
+{
+ unsigned char req[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] =
+ {N6110_FRAME_HEADER, 0x72,
+ 0x00, /* mode 0 - open read only, 0x11 - read write create */
+ 0x02,
+ 0xFF, 0xFF}; /* name length */
+ int Pos = 8;
+ GSM_Error error;
+
+ if (Create) req[4] = 0x11;
+ req[6] = (UnicodeLength(Name)*2 + 2)/ 256 ;
+ req[7] = (UnicodeLength(Name)*2 + 2)% 256 ;
+ CopyUnicodeString(req+8,Name);
+ if (req[9] == 'a' || req[9] == 'A') req[9] = 'b';
+ if (req[9] == 'd' || req[9] == 'D') req[9] = 'a';
+ Pos+=UnicodeLength(Name)*2;
+ req[Pos++] = 0;
+ req[Pos++] = 0;
+
+ smprintf(s, "Opening file\n");
+ error = GSM_WaitFor (s, req, Pos, 0x6D, 4, ID_OpenFile);
+ if (error==ERR_NONE) (*Handle) = s->Phone.Data.FileHandle;
+ return error;
+}
+
+static GSM_Error N6510_CloseFile2(GSM_StateMachine *s, int *Handle)
+{
+ unsigned char req[200] = {N6110_FRAME_HEADER, 0x74, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00}; /* file handle */
+
+ req[6] = (*Handle) / (256*256*256);
+ req[7] = (*Handle) / (256*256);
+ req[8] = (*Handle) / 256;
+ req[9] = (*Handle) % 256;
+
+ smprintf(s, "Closing file\n");
+ return GSM_WaitFor (s, req, 10, 0x6D, 4, ID_CloseFile);
+}
+
+static GSM_Error N6510_GetFileCRC2(GSM_StateMachine *s, int *Handle)
+{
+ unsigned char req2[15000] = {
+ N7110_FRAME_HEADER, 0x66, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00}; /* handle */
+
+ req2[6] = (*Handle) / (256*256*256);
+ req2[7] = (*Handle) / (256*256);
+ req2[8] = (*Handle) / 256;
+ req2[9] = (*Handle) % 256;
+ return GSM_WaitFor (s, req2, 10, 0x6D, 8, ID_GetCRC);
+}
+
+GSM_Error N6510_ReplyGetFileFolderInfo2(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_File *FileInfo = s->Phone.Data.FileInfo;
+ GSM_File *File;
+ GSM_Error error;
+
+ switch (msg->Buffer[3]) {
+ case 0x69:
+ case 0x6D:
+ switch (msg->Buffer[4]) {
+ case 0x0C:
+ smprintf(s,"Probably no MMC card\n");
+ Priv->filesystem2error = ERR_MEMORY;
+ Priv->FilesEnd = TRUE;
+ return ERR_MEMORY;
+ case 0x00:
+ case 0x0D:
+ switch (msg->Buffer[5]) {
+ case 0x00:
+ break;
+ case 0x06:
+ smprintf(s,"File not exist\n");
+ return ERR_FILENOTEXIST;
+ case 0x0C:
+ smprintf(s,"Probably no MMC card\n");
+ return ERR_MEMORY;
+ default:
+ smprintf(s,"unknown status code\n");
+ return ERR_UNKNOWNRESPONSE;
+ }
+ smprintf(s,"File or folder details received\n");
+
+ if (msg->Buffer[3] == 0x69) {
+ /* File/Folder without can not be handled */
+ if (UnicodeLength(msg->Buffer+32) == 0) {
+ smprintf(s, "Ignoring file without name!\n");
+ return ERR_NONE;
+ }
+ error = N6510_AllocFileCache(s, Priv->FilesLocationsUsed + 1);
+ if (error != ERR_NONE) {
+ return error;
+ }
+
+ error = N6510_ShiftFileCache(s, 1);
+ if (error != ERR_NONE) return error;
+
+ File = &Priv->FilesCache[1];
+
+ File->Level = Priv->FilesCache[0].Level + 1;
+
+ CopyUnicodeString(File->Name,msg->Buffer+32);
+ smprintf(s,"\"%s\"\n",DecodeUnicodeString(File->Name));
+
+ CopyUnicodeString(File->ID_FullName,FileInfo->ID_FullName);
+ EncodeUnicode(File->ID_FullName+UnicodeLength(File->ID_FullName)*2,"/",1);
+ CopyUnicodeString(File->ID_FullName+UnicodeLength(File->ID_FullName)*2,msg->Buffer+32);
+ smprintf(s,"\"%s\"\n",DecodeUnicodeString(File->ID_FullName));
+ } else {
+ File = FileInfo;
+ }
+
+ smprintf(s, "File type: 0x%02X\n", msg->Buffer[29]);
+ if ((msg->Buffer[29] & 0x10) == 0x10) {
+ File->Folder = TRUE;
+ smprintf(s,"Folder\n");
+ } else {
+ File->Folder = FALSE;
+ smprintf(s,"File\n");
+ File->Used = msg->Buffer[10]*256*256*256+
+ msg->Buffer[11]*256*256+
+ msg->Buffer[12]*256+
+ msg->Buffer[13];
+ smprintf(s,"Size %ld bytes\n", (long)File->Used);
+ }
+ File->ReadOnly = FALSE;
+ if ((msg->Buffer[29] & 1) == 1) {
+ File->ReadOnly = TRUE;
+ smprintf(s,"Readonly\n");
+ }
+ File->Hidden = FALSE;
+ if ((msg->Buffer[29] & 2) == 2) {
+ File->Hidden = TRUE;
+ smprintf(s,"Hidden\n");
+ }
+ File->System = FALSE;
+ if ((msg->Buffer[29] & 4) == 4) {
+ File->System = TRUE;
+ smprintf(s,"System\n");
+ }
+ File->Protected = FALSE;
+ if ((msg->Buffer[29] & 0x40) == 0x40) {
+ File->Protected = TRUE;
+ smprintf(s,"Protected\n");
+ }
+
+ File->ModifiedEmpty = FALSE;
+ NOKIA_DecodeDateTime(s, msg->Buffer+14, &File->Modified, TRUE, FALSE);
+ if (File->Modified.Year == 0x00) File->ModifiedEmpty = TRUE;
+ if (File->Modified.Year == 0xffff) File->ModifiedEmpty = TRUE;
+
+ if (msg->Buffer[3] == 0x69 && msg->Buffer[4] == 0) Priv->FilesEnd = TRUE;
+
+ return ERR_NONE;
+ case 0x06:
+ smprintf(s,"File or folder details received - not available ?\n");
+ Priv->filesystem2error = ERR_FILENOTEXIST;
+ Priv->FilesEnd = TRUE;
+ return ERR_FILENOTEXIST;
+ case 0x0E:
+ smprintf(s,"File or folder details received - empty\n");
+ Priv->FilesEnd = TRUE;
+ return ERR_NONE;
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetFileFolderInfo2(GSM_StateMachine *s, GSM_File *File)
+{
+ int Pos=6;
+ unsigned char req[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER,0x6C,
+ 0xFF, 0xFF}; /* name length */
+
+ s->Phone.Data.FileInfo = File;
+
+ req[4] = (UnicodeLength(File->ID_FullName)*2 + 2)/256;
+ req[5] = (UnicodeLength(File->ID_FullName)*2 + 2)%256;
+ CopyUnicodeString(req+6,File->ID_FullName);
+ if (req[7] == 'a' || req[7] == 'A') req[7] = 'b';
+ if (req[7] == 'd' || req[7] == 'D') req[7] = 'a';
+ Pos+=UnicodeLength(File->ID_FullName)*2;
+ req[Pos++] = 0;
+ req[Pos++] = 0;
+
+ smprintf(s,"Getting info for file in filesystem\n");
+ return GSM_WaitFor (s, req, Pos, 0x6D, 4, ID_GetFileInfo);
+}
+
+static GSM_Error N6510_PrivGetFolderListing2(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_Error error;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ unsigned char req[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N6110_FRAME_HEADER, 0x68,
+ 0xFF, 0xFF}; /* name length */
+ int Pos = 6, i = 0;
+
+ req[4] = (UnicodeLength(File->ID_FullName)*2 + 6)/ 256 ;
+ req[5] = (UnicodeLength(File->ID_FullName)*2 + 6)% 256 ;
+ CopyUnicodeString(req+6,File->ID_FullName);
+ if (req[7] == 'a' || req[7] == 'A') req[7] = 'b';
+ if (req[7] == 'd' || req[7] == 'D') req[7] = 'a';
+ Pos+=UnicodeLength(File->ID_FullName)*2;
+ req[Pos++] = 0;
+ req[Pos++] = '/';
+ req[Pos++] = 0;
+ req[Pos++] = '*';
+ req[Pos++] = 0;
+ req[Pos++] = 0;
+
+ smprintf(s, "Getting folder info %s\n",DecodeUnicodeString(File->ID_FullName));
+
+ Priv->filesystem2error = ERR_NONE;
+ s->Phone.Data.FileInfo = File;
+ Priv->FilesEnd = FALSE;
+ error = s->Protocol.Functions->WriteMessage(s, req, Pos, 0x6D);
+ if (error!=ERR_NONE) return error;
+
+ while (!Priv->FilesEnd) {
+ usleep(1000);
+ if (GSM_ReadDevice(s,TRUE) <= 0) {
+ i++;
+ } else {
+ i=0;
+ }
+ if (i == 3) {
+ smprintf(s,"Connection broken or WELL KNOWN phone firmware problem (which makes, that not all files are reported)\n");
+ Priv->filesystem2error = ERR_FOLDERPART;
+ return ERR_NONE;
+ }
+ }
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetNextFileFolder2(GSM_StateMachine *s, GSM_File *File, gboolean start)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_Error error;
+
+ if (start) {
+ error = N6510_AllocFileCache(s, 2);
+ if (error != ERR_NONE) return error;
+
+ Priv->FilesLocationsUsed = 2;
+
+ Priv->FilesCache[0].Level = 1;
+ Priv->FilesCache[0].Folder = TRUE;
+ Priv->FilesCache[0].Level = 1;
+ Priv->FilesCache[0].ReadOnly = FALSE;
+ Priv->FilesCache[0].System = FALSE;
+ Priv->FilesCache[0].Hidden = FALSE;
+ Priv->FilesCache[0].Protected = FALSE;
+ EncodeUnicode(Priv->FilesCache[0].ID_FullName,"d:",2);
+ EncodeUnicode(Priv->FilesCache[0].Name,"D (Permanent_memory 2)",22);
+
+ Priv->FilesCache[1].Level = 1;
+ Priv->FilesCache[1].Folder = TRUE;
+ Priv->FilesCache[1].Level = 1;
+ Priv->FilesCache[1].ReadOnly = FALSE;
+ Priv->FilesCache[1].System = FALSE;
+ Priv->FilesCache[1].Hidden = FALSE;
+ Priv->FilesCache[1].Protected = FALSE;
+ EncodeUnicode(Priv->FilesCache[1].ID_FullName,"a:",2);
+ EncodeUnicode(Priv->FilesCache[1].Name,"A (Memory card)",15);
+ }
+
+ smprintf(s, "Currently %i locations\n",Priv->FilesLocationsUsed);
+ if (Priv->FilesLocationsUsed == 0) return ERR_EMPTY;
+
+
+ if (!Priv->FilesCache[0].Folder) {
+ memcpy(File,&Priv->FilesCache[0],sizeof(GSM_File));
+ error = N6510_ShiftFileCache(s, -1);
+ if (error != ERR_NONE) return error;
+ smprintf(s, "Returning file %s, level %d\n", DecodeUnicodeString(File->ID_FullName), File->Level);
+ return ERR_NONE;
+ }
+
+ memcpy(File,&Priv->FilesCache[0],sizeof(GSM_File));
+ error = N6510_PrivGetFolderListing2(s, File);
+ if (error != ERR_NONE) return error;
+
+ memcpy(File,&Priv->FilesCache[0],sizeof(GSM_File));
+ error = N6510_ShiftFileCache(s, -1);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Returning folder %s, level %d\n", DecodeUnicodeString(File->ID_FullName), File->Level);
+
+ if (Priv->filesystem2error == ERR_FOLDERPART) return ERR_FOLDERPART;
+
+ return error;
+}
+
+static GSM_Error N6510_GetFilePart2(GSM_StateMachine *s, GSM_File *File, int *Handle, size_t *Size)
+{
+ int old,j;
+ GSM_Error error;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ unsigned char req[] = {
+ N7110_FRAME_HEADER, 0x5E, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x01, /* file handle */
+ 0x00, 0x00, 0x00, 0x00, /* position */
+ 0x00, 0x00, 0x03, 0xE8, /* length */
+ 0x00, 0x00, 0x03, 0xE8}; /* buffer length */
+
+ if (File->Used == 0x00) {
+ error = N6510_GetFileFolderInfo2(s, File);
+ if (error != ERR_NONE) return error;
+
+ if (File->Folder) return ERR_SHOULDBEFILE;
+
+ error = N6510_OpenFile2(s, File->ID_FullName, Handle, FALSE);
+ if (error != ERR_NONE) return error;
+
+ for (j=UnicodeLength(File->ID_FullName)-1;j>0;j--) {
+ if (File->ID_FullName[j*2+1] == '\\' || File->ID_FullName[j*2+1] == '/') break;
+ }
+ if (File->ID_FullName[j*2+1] == '\\' || File->ID_FullName[j*2+1] == '/') {
+ CopyUnicodeString(File->Name,File->ID_FullName+j*2+2);
+ } else {
+ CopyUnicodeString(File->Name,File->ID_FullName);
+ }
+
+ (*Size) = File->Used;
+ File->Used = 0;
+ }
+
+ req[6] = (*Handle) / (256*256*256);
+ req[7] = (*Handle) / (256*256);
+ req[8] = (*Handle) / 256;
+ req[9] = (*Handle) % 256;
+
+ old = File->Used;
+ req[10] = old / (256*256*256);
+ req[11] = old / (256*256);
+ req[12] = old / 256;
+ req[13] = old % 256;
+
+ s->Phone.Data.File = File;
+ smprintf(s, "Getting file part from filesystem\n");
+ error=GSM_WaitFor (s, req, 22, 0x6D, 4, ID_GetFile);
+ if (error != ERR_NONE) return error;
+
+ if (File->Used - old != (0x03 * 256 + 0xE8)) {
+ error = N6510_GetFileCRC2(s, Handle);
+ if (error != ERR_NONE) return error;
+
+ error = N6510_CloseFile2(s, Handle);
+ if (error != ERR_NONE) return error;
+
+ if (N6510_FindFileCheckSum12(s, File->Buffer, File->Used) != Priv->FileCheckSum) {
+ smprintf(s,"File2 checksum is %i, File checksum is %i\n",N6510_FindFileCheckSum12(s, File->Buffer, File->Used),Priv->FileCheckSum);
+ return ERR_WRONGCRC;
+ }
+
+ return ERR_EMPTY;
+ }
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplySetFileDate2(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s UNUSED)
+{
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplySetAttrib2(GSM_Protocol_Message *msg, GSM_StateMachine *s UNUSED)
+{
+ if (msg->Buffer[4] == 0x00) {
+ return ERR_NONE;
+ } else if (msg->Buffer[4] == 0x06) {
+ return ERR_FILENOTEXIST;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_SetFileAttributes2(GSM_StateMachine *s, GSM_File *File)
+{
+ int P = 10;
+ GSM_Error error;
+ GSM_File File2;
+ unsigned char Header2[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER, 0x6E,
+ 0x00, 0x0c}; /* name len */
+
+ memcpy(&File2,File,sizeof(GSM_File));
+
+ error = N6510_GetFileFolderInfo2(s, File);
+ if (error != ERR_NONE) return error;
+
+ /* haven't checked. */
+ if (File->Folder) return ERR_SHOULDBEFILE;
+
+ Header2[4] = (UnicodeLength(File2.ID_FullName) + 1)/ 256 ;
+ Header2[5] = (UnicodeLength(File2.ID_FullName) + 1)% 256 ;
+ Header2[6] = 0x00;
+ Header2[7] = 0x00;
+ Header2[8] = 0x00;
+ Header2[9] = 0x00;
+ if (File2.ReadOnly) Header2[9] += 1;
+ if (File2.Hidden) Header2[9] += 2;
+ if (File2.System) Header2[9] += 4;
+ if (File2.Protected) Header2[9] += 0x40;
+ CopyUnicodeString(Header2+10,File2.ID_FullName);
+ if (Header2[11] == 'a' || Header2[11] == 'A') Header2[11] = 'b';
+ if (Header2[11] == 'd' || Header2[11] == 'D') Header2[11] = 'a';
+ P+=UnicodeLength(File2.ID_FullName)*2;
+ Header2[P++] = 0;
+ Header2[P++] = 0;
+ error = GSM_WaitFor (s, Header2, P, 0x6D, 4, ID_SetAttrib);
+ if (error != ERR_NONE) return error;
+
+ error = N6510_GetFileFolderInfo2(s, File);
+ if (error != ERR_NONE) return error;
+
+ /* mmc doesn't support protected */
+ if (File2.System != File->System ||
+ File2.ReadOnly != File->ReadOnly ||
+ File2.Hidden != File->Hidden ) {
+/* File2.Protected != File->Protected) { */
+ return ERR_NOTSUPPORTED;
+ }
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_AddFilePart2(GSM_StateMachine *s, GSM_File *File, size_t *Pos, int *Handle)
+{
+ GSM_Error error;
+ int j,P;
+/* GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510; */
+/* unsigned char buffer[500]; */
+ unsigned char req[15000] = {
+ N7110_FRAME_HEADER, 0x58, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, /* handle */
+ 0x00, 0x00, 0x04, 0x00}; /* buffer len */
+ unsigned char Header[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER, 0x86,
+ 0x00, 0x0c}; /* name len */
+
+ s->Phone.Data.File = File;
+
+ if (*Pos == 0) {
+ EncodeUnicode(File->ID_FullName+UnicodeLength(File->ID_FullName)*2,"/",1);
+ CopyUnicodeString(File->ID_FullName+UnicodeLength(File->ID_FullName)*2,File->Name);
+
+ error = N6510_GetFileFolderInfo2(s, File);
+ switch (error) {
+ case ERR_FILENOTEXIST:
+ break;
+ case ERR_NONE:
+ return ERR_FILEALREADYEXIST;
+ default:
+ return error;
+ }
+
+ error = N6510_OpenFile2(s, File->ID_FullName, Handle, TRUE);
+ if (error != ERR_NONE) return error;
+ }
+
+ req[6] = (*Handle) / (256*256*256);
+ req[7] = (*Handle) / (256*256);
+ req[8] = (*Handle) / 256;
+ req[9] = (*Handle) % 256;
+
+ j = 2000;
+ if (File->Used - *Pos < 2000) j = File->Used - *Pos;
+ req[10] = j / (256*256*256);
+ req[11] = j / (256*256);
+ req[12] = j / 256;
+ req[13] = j % 256;
+ memcpy(req+14,File->Buffer+(*Pos),j);
+
+ smprintf(s, "Adding file part %ld %i\n",(long)*Pos,j);
+ error=GSM_WaitFor (s, req, 14+j, 0x6D, 4, ID_AddFile);
+ if (error != ERR_NONE) return error;
+ *Pos = *Pos + j;
+
+ if (j < 2000) {
+ error = N6510_CloseFile2(s, Handle);
+ if (error != ERR_NONE) return error;
+
+ P = 14;
+ Header[4] = (UnicodeLength(File->ID_FullName) + 1)/ 256 ;
+ Header[5] = (UnicodeLength(File->ID_FullName) + 1)% 256 ;
+ Header[6] = File->Modified.Year / 256;
+ Header[7] = File->Modified.Year % 256;
+ Header[8] = File->Modified.Month;
+ Header[9] = File->Modified.Day;
+ Header[10] = 0x00;
+ Header[11] = File->Modified.Hour;
+ Header[12] = File->Modified.Minute;
+ Header[13] = File->Modified.Second;
+ CopyUnicodeString(Header+14,File->ID_FullName);
+ if (Header[15] == 'a' || Header[15] == 'A') Header[15] = 'b';
+ if (Header[15] == 'd' || Header[15] == 'D') Header[15] = 'a';
+ P+=UnicodeLength(File->ID_FullName)*2;
+ req[P++] = 0;
+ req[P++] = 0;
+ smprintf(s,"Setting file date\n");
+ error = GSM_WaitFor (s, Header, P, 0x6D, 4, ID_AddFile);
+ if (error != ERR_NONE) return error;
+
+ error = N6510_SetFileAttributes2(s,File);
+ if (error != ERR_NONE) return error;
+
+/* error = N6510_OpenFile2(s, File->ID_FullName, Handle, FALSE); */
+/* if (error != ERR_NONE) return error; */
+/* if ((*Handle) == 0) { */
+/* error = N6510_OpenFile2(s, File->ID_FullName, Handle, FALSE); */
+/* if (error != ERR_NONE) return error; */
+/* } */
+/* error = N6510_GetFileCRC2(s, Handle); */
+/* if (error != ERR_NONE) return error; */
+/* error = N6510_CloseFile2(s, Handle); */
+/* if (error != ERR_NONE) return error; */
+/* if (N6510_FindFileCheckSum12(s, File->Buffer, File->Used) != Priv->FileCheckSum) { */
+/* smprintf(s,"File2 checksum is %i, File checksum is %i\n",N6510_FindFileCheckSum12(s, File->Buffer, File->Used),Priv->FileCheckSum); */
+/* return ERR_WRONGCRC; */
+/* } */
+
+ return ERR_EMPTY;
+ }
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetFolderListing2(GSM_StateMachine *s, GSM_File *File, gboolean start)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_Error error;
+
+ if (start) {
+ if (strcasecmp(DecodeUnicodeString(File->ID_FullName),"a:") == 0 ||
+ strcasecmp(DecodeUnicodeString(File->ID_FullName),"a:\\") == 0 ||
+ strcasecmp(DecodeUnicodeString(File->ID_FullName),"d:") == 0 ||
+ strcasecmp(DecodeUnicodeString(File->ID_FullName),"d:\\") == 0) {
+ } else {
+ /* we must check, if user gave folder name or not */
+ error = N6510_GetFileFolderInfo2(s, File);
+ if (error != ERR_NONE) return error;
+ if (!File->Folder) return ERR_SHOULDBEFOLDER;
+ }
+
+ error = N6510_AllocFileCache(s, 1);
+ if (error != ERR_NONE) return error;
+
+ Priv->FilesLocationsUsed = 1;
+
+ error = N6510_PrivGetFolderListing2(s, File);
+ if (error != ERR_NONE) return error;
+
+ memcpy(File,&Priv->FilesCache[0],sizeof(GSM_File));
+
+ error = N6510_ShiftFileCache(s, -1);
+ if (error != ERR_NONE) return error;
+ }
+
+ if (Priv->FilesLocationsUsed == 0) return ERR_EMPTY;
+
+ memcpy(File,&Priv->FilesCache[0],sizeof(GSM_File));
+
+ error = N6510_ShiftFileCache(s, -1);
+ if (error != ERR_NONE) return error;
+
+ if (start) {
+ if (Priv->filesystem2error == ERR_FOLDERPART) return ERR_FOLDERPART;
+ }
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplyDeleteFile2(GSM_Protocol_Message *msg, GSM_StateMachine *s UNUSED)
+{
+ if (msg->Buffer[4] == 0x00) {
+ return ERR_NONE;
+ } else if (msg->Buffer[4] == 0x03) {
+ /* trying to delete read only */
+ return ERR_UNKNOWN;
+ } else if (msg->Buffer[4] == 0x06) {
+ return ERR_FILENOTEXIST;
+ }
+
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_DeleteFile2(GSM_StateMachine *s, unsigned char *ID)
+{
+ unsigned char req[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER, 0x62};
+ int Pos = 6;
+ GSM_File file;
+ GSM_Error error;
+
+ /* first remove readonly */
+ file.ReadOnly = FALSE;
+ file.Hidden = FALSE;
+ file.System = FALSE;
+ file.Protected = FALSE;
+
+ CopyUnicodeString(file.ID_FullName,ID);
+ error = N6510_SetFileAttributes2(s,&file);
+ if (error != ERR_NONE) return error;
+
+ req[4] = (UnicodeLength(ID)*2 + 2)/ 256 ;
+ req[5] = (UnicodeLength(ID)*2 + 2)% 256 ;
+ CopyUnicodeString(req+6,ID);
+ if (req[7] == 'a' || req[7] == 'A') req[7] = 'b';
+ if (req[7] == 'd' || req[7] == 'D') req[7] = 'a';
+ Pos+=UnicodeLength(ID)*2;
+ req[Pos++] = 0;
+ req[Pos++] = 0;
+
+ smprintf(s,"Deleting file\n");
+ return GSM_WaitFor (s, req, Pos, 0x6D, 4, ID_DeleteFile);
+}
+
+GSM_Error N6510_ReplyAddFolder2(GSM_Protocol_Message *msg, GSM_StateMachine *s UNUSED)
+{
+ if (msg->Buffer[4] == 0x00) {
+ return ERR_NONE;
+ } if (msg->Buffer[4] == 0x04) {
+ return ERR_FILEALREADYEXIST;
+ } if (msg->Buffer[4] == 0x06) {
+ return ERR_FILENOTEXIST;
+ } if (msg->Buffer[4] == 0x0C) {
+ return ERR_MEMORY;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_AddFolder2(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_Error error;
+ unsigned char req[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER, 0x64};
+ int Pos = 6;
+ int Len = 0;
+
+ Len = UnicodeLength(File->ID_FullName)*2 + 2;
+
+ CopyUnicodeString(req+6,File->ID_FullName);
+ Pos+=UnicodeLength(File->ID_FullName)*2;
+ if (DecodeUnicodeString(File->ID_FullName)[UnicodeLength(File->ID_FullName)-1] != '\\' &&
+ DecodeUnicodeString(File->ID_FullName)[UnicodeLength(File->ID_FullName)-1] != '/') {
+ req[Pos++] = 0;
+ req[Pos++] = '/';
+ Len += 2;
+ }
+ CopyUnicodeString(req+Pos,File->Name);
+ if (req[Pos+1] == 'a' || req[Pos+1] == 'A') req[Pos+1] = 'b';
+ if (req[Pos+1] == 'd' || req[Pos+1] == 'D') req[Pos+1] = 'a';
+ Pos += UnicodeLength(File->Name)*2;
+ Len += UnicodeLength(File->Name)*2;
+ req[Pos++] = 0;
+ req[Pos++] = 0;
+ req[4] = Len / 256 ;
+ req[5] = Len % 256 ;
+ smprintf(s,"Adding folder\n");
+ error=GSM_WaitFor (s, req, Pos, 0x6D, 4, ID_AddFolder);
+ if (error == ERR_NONE) memcpy(File->ID_FullName,req+6,Pos);
+ return error;
+}
+
+GSM_Error N6510_ReplyDeleteFolder2(GSM_Protocol_Message *msg, GSM_StateMachine *s UNUSED)
+{
+ if (msg->Buffer[4] == 0x00) {
+ return ERR_NONE;
+ } if (msg->Buffer[4] == 0x03) {
+ return ERR_SHOULDBEFOLDER;
+ } if (msg->Buffer[4] == 0x06) {
+ return ERR_FILENOTEXIST;
+ } if (msg->Buffer[4] == 0x0C) {
+ return ERR_MEMORY;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_DeleteFolder2(GSM_StateMachine *s, unsigned char *ID)
+{
+ GSM_File File2;
+ GSM_Error error;
+ unsigned char req[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))] = {
+ N7110_FRAME_HEADER, 0x6A};
+ int Pos = 6;
+
+ /* we don't want to allow deleting non empty folders */
+ CopyUnicodeString(File2.ID_FullName,ID);
+ error = N6510_GetFolderListing2(s, &File2, TRUE);
+ switch (error) {
+ case ERR_EMPTY:
+ break;
+ case ERR_NONE:
+ return ERR_FOLDERNOTEMPTY;
+ default:
+ return error;
+ }
+
+ req[4] = (UnicodeLength(ID)*2 + 2)/ 256 ;
+ req[5] = (UnicodeLength(ID)*2 + 2)% 256 ;
+ CopyUnicodeString(req+6,ID);
+ if (req[7] == 'a' || req[7] == 'A') req[7] = 'b';
+ if (req[7] == 'd' || req[7] == 'D') req[7] = 'a';
+ Pos+=UnicodeLength(ID)*2;
+ req[Pos++] = 0;
+ req[Pos++] = 0;
+
+ smprintf(s,"Deleting folder\n");
+ return GSM_WaitFor (s, req, Pos, 0x6D, 4, ID_DeleteFolder);
+}
+
+/* shared */
+
+GSM_Error N6510_GetFolderListing(GSM_StateMachine *s, GSM_File *File, gboolean start)
+{
+ GSM_Error error;
+ GSM_File File2;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (DecodeUnicodeString(File->ID_FullName)[0] == 'c' ||
+ DecodeUnicodeString(File->ID_FullName)[0] == 'C') {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ memcpy(&File2,File,sizeof(GSM_File));
+ CopyUnicodeString(File2.ID_FullName,File->ID_FullName+3*2);
+ error = N6510_GetFolderListing1(s,&File2,start);
+ memcpy(File,&File2,sizeof(GSM_File));
+ /* GetFolderListing changes ID */
+ EncodeUnicode(File->ID_FullName,"c:/",3);
+ CopyUnicodeString(File->ID_FullName+UnicodeLength(File->ID_FullName)*2,File2.ID_FullName);
+ return error;
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return N6510_GetFolderListing2(s,File,start);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+}
+
+GSM_Error N6510_GetNextFileFolder(GSM_StateMachine *s, GSM_File *File, gboolean start)
+{
+ GSM_Error error;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ char buf[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))];
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (start) {
+ Priv->UseFs1 = TRUE;
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ /* series 40 3.0 don't have filesystem 1 */
+ Priv->UseFs1 = FALSE;
+ }
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ Priv->UseFs1 = FALSE;
+ }
+ }
+ if (Priv->UseFs1) {
+ error = N6510_GetNextFileFolder1(s,File,start);
+ if (error == ERR_EMPTY) {
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return error;
+ }
+ Priv->UseFs1 = FALSE;
+ start = TRUE;
+ } else {
+ if (error == ERR_NONE) {
+ sprintf(buf,"c:/%s",DecodeUnicodeString(File->ID_FullName));
+ EncodeUnicode(File->ID_FullName,buf,strlen(buf));
+
+ if (File->Level != 1) return error;
+
+ buf[0] = 0;
+ buf[1] = 0;
+ CopyUnicodeString(buf,File->Name);
+ EncodeUnicode(File->Name,"C (",3);
+ CopyUnicodeString(File->Name+6,buf);
+ EncodeUnicode(File->Name+UnicodeLength(File->Name)*2,")",1);
+ }
+ return error;
+ }
+ }
+ return N6510_GetNextFileFolder2(s,File,start);
+}
+
+GSM_Error N6510_GetFilePart(GSM_StateMachine *s, GSM_File *File, int *Handle, size_t *Size)
+{
+ GSM_File File2;
+ char buf[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))];
+ GSM_Error error;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (DecodeUnicodeString(File->ID_FullName)[0] == 'c' ||
+ DecodeUnicodeString(File->ID_FullName)[0] == 'C') {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+ memcpy(&File2,File,sizeof(GSM_File));
+ CopyUnicodeString(File2.ID_FullName,File->ID_FullName+3*2);
+ error = N6510_GetFilePart1(s,&File2, Handle, Size);
+ CopyUnicodeString(buf,File->ID_FullName);
+ memcpy(File,&File2,sizeof(GSM_File));
+ CopyUnicodeString(File->ID_FullName,buf);
+ return error;
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return N6510_GetFilePart2(s,File, Handle, Size);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+}
+
+GSM_Error N6510_AddFilePart(GSM_StateMachine *s, GSM_File *File, size_t *Pos, int *Handle)
+{
+ GSM_File File2;
+ GSM_Error error;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (DecodeUnicodeString(File->ID_FullName)[0] == 'c' ||
+ DecodeUnicodeString(File->ID_FullName)[0] == 'C') {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ memcpy(&File2,File,sizeof(GSM_File));
+ CopyUnicodeString(File2.ID_FullName,File->ID_FullName+3*2);
+ error = N6510_AddFilePart1(s,&File2,Pos,Handle);
+ memcpy(File,&File2,sizeof(GSM_File));
+ /* addfilepart returns new ID */
+ EncodeUnicode(File->ID_FullName,"c:/",3);
+ CopyUnicodeString(File->ID_FullName+UnicodeLength(File->ID_FullName)*2,File2.ID_FullName);
+ return error;
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return N6510_AddFilePart2(s,File,Pos,Handle);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+}
+
+GSM_Error N6510_DeleteFile(GSM_StateMachine *s, unsigned char *ID)
+{
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (DecodeUnicodeString(ID)[0] == 'c' ||
+ DecodeUnicodeString(ID)[0] == 'C') {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ return N6510_DeleteFile1(s,ID+6);
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return N6510_DeleteFile2(s,ID);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+}
+
+GSM_Error N6510_AddFolder(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_File File2;
+ GSM_Error error;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (DecodeUnicodeString(File->ID_FullName)[0] == 'c' ||
+ DecodeUnicodeString(File->ID_FullName)[0] == 'C') {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+ memcpy(&File2,File,sizeof(GSM_File));
+ CopyUnicodeString(File2.ID_FullName,File->ID_FullName+3*2);
+ error = N6510_AddFolder1(s,&File2);
+ memcpy(File,&File2,sizeof(GSM_File));
+ /* addfolder returns new ID */
+ EncodeUnicode(File->ID_FullName,"c:/",3);
+ CopyUnicodeString(File->ID_FullName+UnicodeLength(File->ID_FullName)*2,File2.ID_FullName);
+ return error;
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return N6510_AddFolder2(s,File);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+}
+
+GSM_Error N6510_DeleteFolder(GSM_StateMachine *s, unsigned char *ID)
+{
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (DecodeUnicodeString(ID)[0] == 'c' ||
+ DecodeUnicodeString(ID)[0] == 'C') {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+ return N6510_DeleteFolder1(s,ID+6);
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return N6510_DeleteFolder2(s,ID);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+}
+
+GSM_Error N6510_GetFileSystemStatus(GSM_StateMachine *s, GSM_FileSystemStatus *status)
+{
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return ERR_NOTSUPPORTED;
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+ return N6510_GetFileSystemStatus1(s,status);
+ }
+}
+
+GSM_Error N6510_SetFileAttributes(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_File File2;
+ char buf[20 + (2 * (GSM_MAX_FILENAME_ID_LENGTH + 1))];
+ GSM_Error error;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ if (DecodeUnicodeString(File->ID_FullName)[0] == 'c' ||
+ DecodeUnicodeString(File->ID_FullName)[0] == 'C') {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ return ERR_NOTSUPPORTED;
+ }
+ memcpy(&File2,File,sizeof(GSM_File));
+ CopyUnicodeString(File2.ID_FullName,File->ID_FullName+3*2);
+ error = N6510_SetFileAttributes1(s,&File2);
+ CopyUnicodeString(buf,File->ID_FullName);
+ memcpy(File,&File2,sizeof(GSM_File));
+ CopyUnicodeString(File->ID_FullName,buf);
+ return error;
+ } else {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ return N6510_SetFileAttributes2(s,File);
+ } else {
+ return ERR_NOTSUPPORTED;
+ }
+ }
+}
+
+GSM_Error N6510_GetNextRootFolder(GSM_StateMachine *s, GSM_File *File)
+{
+ GSM_Error error;
+ GSM_File File2;
+ unsigned char buffer[5];
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ memset(&File2, 0, sizeof(File2));
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) ||
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILE1)) {
+ if (UnicodeLength(File->ID_FullName) == 0) {
+ EncodeUnicode(File->ID_FullName,"d:",2);
+ EncodeUnicode(File->Name,"D (Permanent_memory 2)",22);
+ } else if (!strcmp(DecodeUnicodeString(File->ID_FullName),"d:")) {
+ EncodeUnicode(File->ID_FullName,"a:",2);
+ error = N6510_GetFolderListing2(s, File, TRUE);
+ if (error != ERR_NONE && error != ERR_EMPTY) return ERR_EMPTY;
+ EncodeUnicode(File->Name,"A (Memory card)",15);
+ EncodeUnicode(File->ID_FullName,"a:",2);
+ } else {
+ return ERR_EMPTY;
+ }
+ return ERR_NONE;
+ }
+
+ if (UnicodeLength(File->ID_FullName) == 0) {
+ sprintf(buffer,"%i",0x01);
+ EncodeUnicode(File2.ID_FullName,buffer,strlen(buffer));
+ File2.Level = 1;
+
+ error = N6510_GetFileFolderInfo1(s, &File2, FALSE);
+ if (error != ERR_NONE) return error;
+ }
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ if (UnicodeLength(File->ID_FullName) == 0) {
+ memcpy(File,&File2,sizeof(GSM_File));
+ EncodeUnicode(File->Name,"C (",3);
+ CopyUnicodeString(File->Name+6,File2.Name);
+ EncodeUnicode(File->Name+UnicodeLength(File->Name)*2,")",1);
+ sprintf(buffer,"c:\\%i",0x01);
+ EncodeUnicode(File->ID_FullName,buffer,strlen(buffer));
+ } else if (!strcmp(DecodeUnicodeString(File->ID_FullName),"c:\\1")) {
+ EncodeUnicode(File->ID_FullName,"d:",2);
+ EncodeUnicode(File->Name,"D (Permanent_memory 2)",22);
+ } else if (!strcmp(DecodeUnicodeString(File->ID_FullName),"d:")) {
+ EncodeUnicode(File->ID_FullName,"a:",2);
+ error = N6510_GetFolderListing2(s, File, TRUE);
+ if (error != ERR_NONE && error != ERR_EMPTY) return ERR_EMPTY;
+ EncodeUnicode(File->Name,"A (Memory card)",15);
+ EncodeUnicode(File->ID_FullName,"a:",2);
+ } else {
+ return ERR_EMPTY;
+ }
+ return ERR_NONE;
+ }
+ if (UnicodeLength(File->ID_FullName) == 0) {
+ memcpy(File,&File2,sizeof(GSM_File));
+ EncodeUnicode(File->Name,"C (",3);
+ CopyUnicodeString(File->Name+6,File2.Name);
+ EncodeUnicode(File->Name+UnicodeLength(File->Name)*2,")",1);
+ sprintf(buffer,"c:\\%i",0x01);
+ EncodeUnicode(File->ID_FullName,buffer,strlen(buffer));
+ } else if (!strcmp(DecodeUnicodeString(File->ID_FullName),"c:\\1")) {
+ return ERR_EMPTY;
+ }
+ return ERR_NONE;
+}
+
+GSM_Error N6510_PrivGet3220FilesystemMMSFolders(GSM_StateMachine *s, GSM_MMSFolders *folders)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ gboolean Start = TRUE;
+ GSM_File Files;
+ GSM_Error error;
+
+ memset(&Files, 0, sizeof(Files));
+
+ EncodeUnicode(Files.ID_FullName,"d:/predefmessages",17);
+
+ folders->Number = 0;
+
+ smprintf(s, "Getting MMS folders\n");
+ while (1) {
+ error = N6510_GetFolderListing(s,&Files,Start);
+ if (error == ERR_EMPTY) return ERR_NONE;
+ if (error != ERR_NONE) return error;
+
+ Start = FALSE;
+
+ folders->Folder[folders->Number].InboxFolder = FALSE;
+ if (!strcmp(DecodeUnicodeString(Files.Name),"predefinbox")) {
+ folders->Folder[folders->Number].InboxFolder = TRUE;
+ }
+
+ CopyUnicodeString(Priv->MMSFoldersID2[folders->Number],Files.ID_FullName);
+
+ if (!strcmp(DecodeUnicodeString(Files.Name),"predefinbox")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Inbox",5);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefsent")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Sent items",10);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefoutbox")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Outbox",6);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefdrafts")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Templates",9);
+ } else {
+ continue;
+ }
+
+ folders->Number++;
+ }
+}
+
+/* Series 40 3.0 */
+GSM_Error N6510_PrivGetFilesystemMMSFolders(GSM_StateMachine *s, GSM_MMSFolders *folders)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ gboolean Start = TRUE;
+ GSM_File Files;
+ GSM_Error error;
+
+ memset(&Files, 0, sizeof(Files));
+
+ EncodeUnicode(Files.ID_FullName,"d:/predefmessages",17);
+
+ folders->Number = 0;
+
+ smprintf(s, "Getting MMS folders\n");
+ while (1) {
+ error = N6510_GetFolderListing(s,&Files,Start);
+ if (error == ERR_EMPTY) return ERR_NONE;
+ if (error != ERR_NONE) return error;
+
+ Start = FALSE;
+
+ if (!strcmp(DecodeUnicodeString(Files.Name),"exchange")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefdrafts")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefsent")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefoutbox")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefinbox")) {
+ continue;
+ }
+
+ folders->Folder[folders->Number].InboxFolder = FALSE;
+ if (!strcmp(DecodeUnicodeString(Files.Name),"1")) {
+ folders->Folder[folders->Number].InboxFolder = TRUE;
+ }
+
+ CopyUnicodeString(Priv->MMSFoldersID2[folders->Number],Files.ID_FullName);
+
+ if (!strcmp(DecodeUnicodeString(Files.Name),"1")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Inbox",5);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"3")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Sent items",10);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"4")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Saved messages",14);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"5")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Drafts",6);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"6")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Templates",9);
+ } else {
+ CopyUnicodeString(folders->Folder[folders->Number].Name,Files.Name);
+ }
+
+ folders->Number++;
+ }
+}
+
+GSM_Error N6510_GetMMSFolders(GSM_StateMachine *s, GSM_MMSFolders *folders)
+{
+ GSM_Error error;
+ GSM_File Files;
+ gboolean Start = TRUE;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int i;
+
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOFILESYSTEM)) return ERR_NOTSUPPORTED;
+
+ memset(&Files, 0, sizeof(Files));
+
+ for (i=0;i<10;i++) {
+ Priv->MMSFoldersID2[i][0] = 0;
+ Priv->MMSFoldersID2[i][1] = 0;
+ }
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_3220_MMS)) {
+ return N6510_PrivGet3220FilesystemMMSFolders(s,folders);
+ }
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ return N6510_PrivGetFilesystemMMSFolders(s,folders);
+ }
+
+ EncodeUnicode(Files.ID_FullName,"c:/1",4);
+ while (1) {
+ error = N6510_GetFolderListing(s,&Files,Start);
+ if (error == ERR_EMPTY) break;
+ if (error != ERR_NONE) return error;
+ Start = FALSE;
+ if (!Files.Folder || strcmp(DecodeUnicodeConsole(Files.Name),"Messages")) {
+ continue;
+ }
+ Start = TRUE;
+ folders->Number = 0;
+
+ while (1) {
+ error = N6510_GetFolderListing(s,&Files,Start);
+ if (error == ERR_EMPTY) return ERR_NONE;
+ if (error != ERR_NONE) return error;
+ Start = FALSE;
+ if (!Files.Folder) continue;
+ CopyUnicodeString(folders->Folder[folders->Number].Name,Files.Name);
+ CopyUnicodeString(Priv->MMSFoldersID2[folders->Number],Files.ID_FullName);
+ folders->Folder[folders->Number].InboxFolder = FALSE;
+ if (!strcmp(DecodeUnicodeString(Files.Name),"Inbox")) {
+ folders->Folder[folders->Number].InboxFolder = TRUE;
+ }
+ folders->Number++;
+ }
+ }
+
+ /* 6230i */
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_FILES2)) {
+ EncodeUnicode(Files.ID_FullName,"d:/predefmessages",17);
+ folders->Number = 0;
+ Start = TRUE;
+ while (1) {
+ error = N6510_GetFolderListing(s,&Files,Start);
+ if (error == ERR_EMPTY) break;
+ if (error != ERR_NONE) return error;
+ Start = FALSE;
+ if (!Files.Folder) continue;
+ folders->Folder[folders->Number].InboxFolder = FALSE;
+ if (!strcmp(DecodeUnicodeString(Files.Name),"predefinbox")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Inbox",5);
+ folders->Folder[folders->Number].InboxFolder = TRUE;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefoutbox")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Outbox",6);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefsent")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Sent items",10);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefdrafts")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Drafts",6);
+ } else {
+ CopyUnicodeString(folders->Folder[folders->Number].Name,Files.Name);
+ }
+ CopyUnicodeString(Priv->MMSFoldersID2[folders->Number],Files.ID_FullName);
+ folders->Number++;
+ }
+
+ return ERR_NONE;
+ }
+
+ return ERR_NOTSUPPORTED;
+}
+
+GSM_Error N6510_GetNextMMSFileInfo(GSM_StateMachine *s, unsigned char *FileID, int *MMSFolder, gboolean start)
+{
+ GSM_MMSFolders folders;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_Error error;
+ GSM_File file;
+ int Handle;
+ size_t Size;
+
+ if (start) {
+ error = N6510_GetMMSFolders(s, &folders);
+ if (error != ERR_NONE)
+ return error;
+
+ Priv->MMSFolderNum = 0;
+ Priv->MMSFolderError = ERR_EMPTY;
+ }
+
+ while(TRUE) {
+ if (Priv->MMSFolderError == ERR_NONE) {
+ Priv->MMSFolderError = N6510_GetFolderListing(s,&Priv->MMSFile,FALSE);
+ if (Priv->MMSFolderError != ERR_EMPTY && Priv->MMSFolderError != ERR_NONE)
+ return Priv->MMSFolderError;
+ }
+
+ if (Priv->MMSFolderError == ERR_EMPTY) {
+ while (1) {
+ if (UnicodeLength(Priv->MMSFoldersID2[Priv->MMSFolderNum]) == 0)
+ return ERR_EMPTY;
+
+ CopyUnicodeString(Priv->MMSFile.ID_FullName,Priv->MMSFoldersID2[Priv->MMSFolderNum]);
+ Priv->MMSFolderNum++;
+
+ Priv->MMSFolderError = N6510_GetFolderListing(s,&Priv->MMSFile,TRUE);
+ if (Priv->MMSFolderError == ERR_EMPTY)
+ continue;
+ if (Priv->MMSFolderError != ERR_NONE)
+ return Priv->MMSFolderError;
+ break;
+ }
+ }
+ (*MMSFolder) = Priv->MMSFolderNum;
+ CopyUnicodeString(FileID,Priv->MMSFile.ID_FullName);
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ CopyUnicodeString(file.ID_FullName,FileID);
+ file.Used = 0;
+ file.Buffer = NULL;
+ error = N6510_GetFilePart2(s, &file, &Handle, &Size);
+ if (error == ERR_NONE) {
+ error = N6510_CloseFile2(s, &Handle);
+ if (error != ERR_NONE)
+ return error;
+ } else if (error != ERR_EMPTY) {
+ return error;
+ }
+
+ /* 0x00 = SMS, 0x01,0x03 = MMS */
+ if (file.Buffer[6] != 0x00) {
+ free(file.Buffer);
+ file.Buffer = NULL;
+ break;
+ }
+ free(file.Buffer);
+ file.Buffer = NULL;
+ } else {
+ break;
+ }
+ }
+
+ return ERR_NONE;
+}
+
+/* Series 40 3.0 */
+GSM_Error N6510_PrivGetFilesystemSMSFolders(GSM_StateMachine *s, GSM_SMSFolders *folders, gboolean real)
+{
+ gboolean Start = TRUE;
+ GSM_File Files;
+ GSM_Error error;
+
+ EncodeUnicode(Files.ID_FullName,"d:/predefmessages",17);
+
+ folders->Number = 0;
+
+ smprintf(s, "Getting SMS folders\n");
+ while (1) {
+ error = N6510_GetFolderListing(s,&Files,Start);
+ if (error == ERR_EMPTY) return ERR_NONE;
+ if (error != ERR_NONE) return error;
+
+ Start = FALSE;
+
+ smprintf(s, "Folder name: '%s'\n", DecodeUnicodeString(Files.Name));
+
+ if (!strcmp(DecodeUnicodeString(Files.Name),"exchange")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefdrafts")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefsent")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefoutbox")) {
+ continue;
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"predefinbox")) {
+ continue;
+ }
+
+ folders->Folder[folders->Number].InboxFolder = FALSE;
+ if (!strcmp(DecodeUnicodeString(Files.Name),"1")) {
+ folders->Folder[folders->Number].InboxFolder = TRUE;
+ }
+ folders->Folder[folders->Number].OutboxFolder = FALSE;
+ if (!strcmp(DecodeUnicodeString(Files.Name),"2")) {
+ folders->Folder[folders->Number].OutboxFolder = TRUE;
+ }
+ if (real) {
+ CopyUnicodeString(folders->Folder[folders->Number].Name,Files.Name);
+ } else {
+ if (!strcmp(DecodeUnicodeString(Files.Name),"1")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Inbox",5);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"2")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Outbox",6);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"3")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Sent items",10);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"4")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Saved messages",14);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"5")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Drafts",6);
+ } else if (!strcmp(DecodeUnicodeString(Files.Name),"6")) {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"Templates",9);
+ } else {
+ EncodeUnicode(folders->Folder[folders->Number].Name,"User folder ",12);
+ CopyUnicodeString(folders->Folder[folders->Number].Name + 24, Files.Name);
+ }
+ }
+ folders->Folder[folders->Number].Memory = MEM_ME;
+ smprintf(s, "Folder[%d] = \"%s\", memory: %s, inbox: %d, outbox: %d\n",
+ folders->Number,
+ DecodeUnicodeString(folders->Folder[folders->Number].Name),
+ GSM_MemoryTypeToString(folders->Folder[folders->Number].Memory),
+ folders->Folder[folders->Number].InboxFolder,
+ folders->Folder[folders->Number].OutboxFolder);
+ folders->Number++;
+ }
+}
+
+/* Series 40 3.0 */
+GSM_Error N6510_GetFilesystemSMSFolders(GSM_StateMachine *s, GSM_SMSFolders *folders)
+{
+ return N6510_PrivGetFilesystemSMSFolders(s, folders, FALSE);
+}
+
+/* Series 40 3.0 */
+static void N26510_GetSMSLocation(GSM_StateMachine *s, GSM_SMSMessage *sms, unsigned char *folderid, int *location)
+{
+ int ifolderid;
+
+ /* simulate flat SMS memory */
+ if (sms->Folder==0x00) {
+ ifolderid = sms->Location / GSM_PHONE_MAXSMSINFOLDER;
+ *folderid = ifolderid + 0x01;
+ *location = sms->Location - ifolderid * GSM_PHONE_MAXSMSINFOLDER;
+ } else {
+ *folderid = sms->Folder;
+ *location = sms->Location;
+ }
+ smprintf(s, "SMS folder %i & location %i -> 6510 folder %i & location %i\n",
+ sms->Folder,sms->Location,*folderid,*location);
+}
+
+/* Series 40 3.0 */
+static void N26510_SetSMSLocation(GSM_StateMachine *s, GSM_SMSMessage *sms, unsigned char folderid, int location)
+{
+ sms->Folder = 0;
+ sms->Location = (folderid - 0x01) * GSM_PHONE_MAXSMSINFOLDER + location;
+ smprintf(s, "6510 folder %i & location %i -> SMS folder %i & location %i\n",
+ folderid,location,sms->Folder,sms->Location);
+}
+
+/* Series 40 3.0 */
+GSM_Error N6510_DecodeFilesystemSMS(GSM_StateMachine *s, GSM_MultiSMSMessage *sms, GSM_File *FFF, int location)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ size_t parse_len, pos;
+ int loc;
+ GSM_Error error;
+ gboolean unknown, has_number;
+
+ sms->Number = 1;
+ sms->SMS[0].OtherNumbersNum = 0;
+
+ loc = sms->SMS[0].Location;
+
+ if (FFF->Used < 96) {
+ smprintf(s, "Too short message data!\n");
+ return ERR_CORRUPTED;
+ }
+
+ /* Copy recipient/sender number */
+ /* Data we get from PDU seem to be bogus */
+ /* This might be later overwriten using tags at the end of file */
+ CopyUnicodeString(sms->SMS[0].Number, FFF->Buffer + 94);
+ smprintf(s, "SMS number: %s\n", DecodeUnicodeString(sms->SMS[0].Number));
+ has_number = FALSE;
+
+ /* Do we have any PDU data? */
+ if (FFF->Buffer[7] > 0 && FFF->Used > 176) {
+ /* Parse PDU data */
+ error = GSM_DecodePDUFrame(&(s->di), &(sms->SMS[0]), FFF->Buffer + 176, FFF->Used - 176, &parse_len, FALSE);
+ if (error != ERR_NONE) return error;
+
+ sms->SMS[0].Location = loc;
+
+ switch (sms->SMS[0].PDU) {
+ case SMS_Deliver:
+ sms->SMS[0].State = SMS_Read; /* @bug FIXME: this is wrong */
+ break;
+ case SMS_Submit:
+ sms->SMS[0].State = SMS_Sent; /* @bug FIXME: this is wrong */
+ break;
+ case SMS_Status_Report:
+ sms->SMS[0].State = SMS_Read; /* @bug FIXME: this is wrong */
+ break;
+ }
+
+ if (parse_len != FFF->Buffer[7]) {
+ smprintf(s, "ERROR: Parsed PDU data have different length than header says!\n");
+ return ERR_CORRUPTED;
+ }
+ } else {
+ GSM_SetDefaultReceivedSMSData(&sms->SMS[0]);
+ sms->SMS[0].PDU = SMS_Submit;
+ sms->SMS[0].State = SMS_Read; /* @bug FIXME: this is wrong */
+ }
+
+ /* Process structured data */
+ pos = 176 + FFF->Buffer[7];
+
+ /* No structured data? */
+ if (pos >= FFF->Used) {
+ goto done;
+ }
+
+ /* First master block - 0x01 <WORD LENGTH> */
+ if (FFF->Buffer[pos] != 0x01) {
+ smprintf(s, "Unknown block in SMS data after PDU: 0x%02x\n", FFF->Buffer[pos]);
+ DumpMessage(&(s->di), FFF->Buffer + pos, FFF->Used - pos);
+ return ERR_UNKNOWN;
+ }
+ pos += 3;
+
+ while (pos < FFF->Used) {
+ unknown = FALSE;
+ if (pos + 1 >= FFF->Used) {
+ if (pos + 1 == FFF->Used && FFF->Buffer[pos] == 0x00) {
+ smprintf(s, "File padded with 0x00, assuming it is okay\n");
+ break;
+ }
+ smprintf(s, "ERROR: Reach end of file before type of block!\n");
+ return ERR_BUG;
+ }
+ if (FFF->Buffer[pos] == 0x00) {
+ smprintf(s, "WARNING: 0x00 block, assuming rest is just junk!\n");
+ break;
+ }
+ if (pos + 2 == FFF->Used && FFF->Buffer[pos] == 0x01) {
+ smprintf(s, "WARNING: 0x01 block, assuming rest is just junk!\n");
+ break;
+ }
+ if (pos + 2 >= FFF->Used) {
+ smprintf(s, "ERROR: Reach end of file before size of block!\n");
+ return ERR_BUG;
+ }
+ switch (FFF->Buffer[pos]) {
+ case 0x02: /* SMSC number, ASCII */
+ if (FFF->Buffer[pos + 2] <= 1) break;
+ if (FFF->Buffer[pos + 2] - 1 > GSM_MAX_NUMBER_LENGTH) {
+ smprintf(s, "WARNING: Too long SMS number, ignoring!\n");
+ } else {
+ EncodeUnicode(sms->SMS[0].SMSC.Number, FFF->Buffer + pos + 3, FFF->Buffer[pos + 2]);
+ }
+ break;
+ case 0x03: /* Name, unicode */
+ if (FFF->Buffer[pos + 2] <= 1) break;
+ if (FFF->Buffer[pos + 2]/2 - 1 > GSM_MAX_SMS_NAME_LENGTH) {
+ smprintf(s, "WARNING: Too long SMS name, ignoring!\n");
+ } else {
+ CopyUnicodeString(sms->SMS[0].Name, FFF->Buffer + pos + 3);
+ }
+ break;
+ case 0x04: /* Sender, unicode */
+ case 0x05: /* Recipient, unicode */
+ case 0x2b: /* some text (Sender?), unicode */
+ if (FFF->Buffer[pos + 2] <= 1) break;
+ if (FFF->Buffer[pos + 2]/2 - 1 > GSM_MAX_NUMBER_LENGTH) {
+ smprintf(s, "WARNING: Too long SMS number, ignoring!\n");
+ } else {
+ if (!has_number) {
+ CopyUnicodeString(sms->SMS[0].Number, FFF->Buffer + pos + 3);
+ has_number = TRUE;
+ } else {
+ if (sms->SMS[0].OtherNumbersNum < GSM_SMS_OTHER_NUMBERS) {
+ CopyUnicodeString(sms->SMS[0].OtherNumbers[sms->SMS[0].OtherNumbersNum++], FFF->Buffer + pos + 3);
+ } else {
+ smprintf(s, "WARNING: Too many recipients, ignoring some!\n");
+ }
+ }
+ }
+ break;
+ case 0x25: /* Some unicode text (Name?) */
+ case 0x20: /* Some ascii text (GmailId) */
+ unknown = TRUE;
+ break;
+ case 0x01:
+ /* This is probably 0 = received, 1 = sent */
+ if (FFF->Buffer[pos + 2] != 1 ||
+ (FFF->Buffer[pos + 3] != 0x00 && FFF->Buffer[pos + 3] != 0x01)) {
+ unknown = TRUE;
+ }
+ break;
+ case 0x0c:
+ /* This seems to be message ID (per number) */
+ break;
+ case 0x24:
+ /* 24$|00 |01 |01 */
+ /* 24$|00 |01 |00 */
+ if ((FFF->Buffer[pos + 2] != 1 || FFF->Buffer[pos + 3] != 1) &&
+ (FFF->Buffer[pos + 2] != 1 || FFF->Buffer[pos + 3] != 0)) {
+ unknown = TRUE;
+ }
+ break;
+ case 0x07:
+ /* 07 |00 |01 |00 */
+ if (FFF->Buffer[pos + 2] != 1 || (FFF->Buffer[pos + 3] != 0x0F && FFF->Buffer[pos + 3] != 0x0e && FFF->Buffer[pos + 3] != 0x00)) {
+ unknown = TRUE;
+ }
+ break;
+ case 0x0b:
+ case 0x0e:
+ case 0x22:
+ /* 22"|00 |01 |84 */
+ case 0x26:
+ case 0x27:
+ case 0x2a:
+ case 0x2f:
+ case 0x08:
+ if (FFF->Buffer[pos + 2] != 1 || FFF->Buffer[pos + 3] != 0x00) {
+ unknown = TRUE;
+ }
+ break;
+ case 0x06:
+ case 0x09:
+ case 0x12:
+ /* Some ID: 12 |00 |04 |355|EA |6En|D2 */
+ case 0x23:
+ /* Some ID: 23#|00 |04 |00 |00 |09 |A6 */
+ case 0x2D:
+ /* Some ID: 2D-|00 |04 |00 |00 |00 |00 */
+ if (FFF->Buffer[pos + 2] != 4 ||
+ FFF->Buffer[pos + 3] != 0x00 ||
+ FFF->Buffer[pos + 4] != 0x00 ||
+ FFF->Buffer[pos + 5] != 0x00 ||
+ FFF->Buffer[pos + 6] != 0x00
+ ) {
+ unknown = TRUE;
+ }
+ break;
+ case 0x0f:
+ if (FFF->Buffer[pos + 2] != 2 ||
+ FFF->Buffer[pos + 3] != 0x00 ||
+ FFF->Buffer[pos + 4] != 0x00
+ ) {
+ unknown = TRUE;
+ }
+ break;
+ default:
+ unknown = TRUE;
+ break;
+ }
+ if (unknown) {
+ smprintf(s, "WARNING: Unknown block 0x%02x, see <https://wammu.eu/support/bugs/> how to report\n", FFF->Buffer[pos]);
+ DumpMessage(&(s->di), FFF->Buffer + pos, 3 + (FFF->Buffer[pos + 1] << 8) + FFF->Buffer[pos + 2]);
+#ifdef DEBUG
+ } else {
+ smprintf(s, "Decoded block 0x%02x\n", FFF->Buffer[pos]);
+ DumpMessage(&(s->di), FFF->Buffer + pos, 3 + (FFF->Buffer[pos + 1] << 8) + FFF->Buffer[pos + 2]);
+#endif
+ }
+ pos += 3 + (FFF->Buffer[pos + 1] << 8) + FFF->Buffer[pos + 2];
+ }
+
+done:
+ sms->SMS[0].DateTime = FFF->Modified;
+ sms->SMS[0].DateTime.Timezone = 0;
+
+ free(FFF->Buffer);
+ FFF->Buffer = NULL;
+
+ N26510_SetSMSLocation(s, &sms->SMS[0], 0, location);
+
+ sms->SMS[0].Folder = Priv->SMSFileFolder;
+ smprintf(s, "Folder[%d] %s: %d\n", sms->SMS[0].Folder, DecodeUnicodeString(Priv->LastSMSFolders.Folder[sms->SMS[0].Folder].Name), Priv->LastSMSFolders.Folder[sms->SMS[0].Folder].InboxFolder);
+ sms->SMS[0].InboxFolder = Priv->LastSMSFolders.Folder[sms->SMS[0].Folder].InboxFolder;
+ sms->SMS[0].Location = 0; /* fixme */
+
+ return ERR_NONE;
+}
+
+GSM_Error N6510_GetNextFilesystemSMS(GSM_StateMachine *s, GSM_MultiSMSMessage *sms, gboolean start)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ unsigned char folderid;
+ int location,Handle;
+ size_t Size;
+ GSM_Error error;
+ GSM_File FFF;
+ gboolean start2=start;
+
+ GSM_SetDefaultReceivedSMSData(&sms->SMS[0]);
+
+ while (TRUE) {
+ if (start2) {
+ Priv->SMSFileError = ERR_EMPTY;
+ Priv->SMSFileFolder = 0;
+ location = 1;
+ error=N6510_PrivGetFilesystemSMSFolders(s,&Priv->LastSMSFolders,TRUE);
+ if (error!=ERR_NONE) return error;
+ } else {
+ sms->SMS[0].Folder = 0;
+ N26510_GetSMSLocation(s, &sms->SMS[0], &folderid, &location);
+ location++;
+ if (Priv->SMSFileError != ERR_EMPTY) {
+ Priv->SMSFileError = N6510_GetFolderListing(s,&Priv->SMSFile,FALSE);
+ }
+ }
+ start2 = FALSE;
+ while (Priv->SMSFileError == ERR_EMPTY) {
+ Priv->SMSFileFolder++;
+ /* Too high folder number */
+ if (Priv->SMSFileFolder > Priv->LastSMSFolders.Number) {
+ return ERR_EMPTY;
+ }
+
+ EncodeUnicode(Priv->SMSFile.ID_FullName, "d:/predefmessages/", 18);
+ CopyUnicodeString(Priv->SMSFile.ID_FullName + 36, Priv->LastSMSFolders.Folder[Priv->SMSFileFolder-1].Name);
+ smprintf(s,"folder name is %s\n", DecodeUnicodeString(Priv->SMSFile.ID_FullName));
+
+ Priv->SMSFileError = N6510_GetFolderListing(s,&Priv->SMSFile,TRUE);
+ }
+
+ /* readfile */
+ FFF.Buffer= NULL;
+ FFF.Used = 0;
+ FFF.ID_FullName[0] = 0;
+ FFF.ID_FullName[1] = 0;
+ CopyUnicodeString(FFF.ID_FullName,Priv->SMSFile.ID_FullName);
+ smprintf(s,"sms file name is %s\n",DecodeUnicodeString(FFF.ID_FullName));
+ error = ERR_NONE;
+ while (error == ERR_NONE) {
+ error = N6510_GetFilePart(s,&FFF,&Handle,&Size);
+ /* if mms, don't read all */
+ if (error==ERR_NONE && FFF.Used>5 && FFF.Buffer[6] != 0x00) {
+ error = N6510_CloseFile2(s, &Handle);
+ if (error != ERR_NONE) return error;
+ break;
+ }
+ }
+ if (FFF.Buffer != NULL) {
+ DumpMessage(&s->di, FFF.Buffer, FFF.Used);
+
+ /* 0x00 = SMS, 0x01,0x03 = MMS
+ * We care only messages with PDU */
+ if (FFF.Buffer[6] == 0x00 && FFF.Buffer[7] != 0) break;
+
+
+ smprintf(s,"mms file");
+ free(FFF.Buffer);
+ FFF.Buffer = NULL;
+ }
+ }
+
+ return N6510_DecodeFilesystemSMS(s, sms, &FFF, location);
+}
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */
diff --git a/libgammu/phone/nokia/dct4s40/6510/6510file.h b/libgammu/phone/nokia/dct4s40/6510/6510file.h
new file mode 100644
index 0000000..12810e9
--- /dev/null
+++ b/libgammu/phone/nokia/dct4s40/6510/6510file.h
@@ -0,0 +1,32 @@
+
+GSM_Error N6510_GetFileSystemStatus (GSM_StateMachine *s, GSM_FileSystemStatus *status);
+GSM_Error N6510_GetNextFileFolder (GSM_StateMachine *s, GSM_File *File, gboolean start);
+GSM_Error N6510_GetFolderListing (GSM_StateMachine *s, GSM_File *File, gboolean start);
+GSM_Error N6510_AddFolder (GSM_StateMachine *s, GSM_File *File);
+GSM_Error N6510_DeleteFolder (GSM_StateMachine *s, unsigned char *ID);
+GSM_Error N6510_GetFilePart (GSM_StateMachine *s, GSM_File *File, int *Handle, size_t *Size);
+GSM_Error N6510_AddFilePart (GSM_StateMachine *s, GSM_File *File, size_t *Pos, int *Handle);
+GSM_Error N6510_DeleteFile (GSM_StateMachine *s, unsigned char *ID);
+GSM_Error N6510_SetFileAttributes (GSM_StateMachine *s, GSM_File *File);
+GSM_Error N6510_GetNextRootFolder (GSM_StateMachine *s, GSM_File *File);
+GSM_Error N6510_GetMMSFolders (GSM_StateMachine *s, GSM_MMSFolders *folders);
+GSM_Error N6510_GetNextMMSFileInfo (GSM_StateMachine *s, unsigned char *FileID, int *MMSFolder, gboolean start);
+GSM_Error N6510_GetFilesystemSMSFolders (GSM_StateMachine *s, GSM_SMSFolders *folders);
+GSM_Error N6510_GetNextFilesystemSMS (GSM_StateMachine *s, GSM_MultiSMSMessage *sms, gboolean start);
+
+GSM_Error N6510_ReplyGetFileCRC12 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplySetAttrib2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplySetFileDate2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyOpenFile2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetFileFolderInfo1 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetFileFolderInfo2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetFileFolderListing2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetFileSystemStatus1 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyGetFilePart12 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddFileHeader1 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddFilePart1 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyDeleteFile2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddFolder1 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyAddFolder2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyDeleteFolder2 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
+GSM_Error N6510_ReplyDeleteFileFolder1 (GSM_Protocol_Message *msg, GSM_StateMachine *s);
diff --git a/libgammu/phone/nokia/dct4s40/6510/n6510.c b/libgammu/phone/nokia/dct4s40/6510/n6510.c
new file mode 100644
index 0000000..86f1cdc
--- /dev/null
+++ b/libgammu/phone/nokia/dct4s40/6510/n6510.c
@@ -0,0 +1,4627 @@
+/* (c) 2002-2005 by Marcin Wiacek */
+/* based on some Markus Plail, Pawel Kot work from Gnokii (www.gnokii.org)
+ * (C) 1999-2000 Hugh Blemings & Pavel Janik ml. (C) 2001-2004 Pawel Kot
+ * GNU GPL version 2 or later
+ */
+/* Due to a problem in the source code management, the names of some of
+ * the authors have unfortunately been lost. We do not mean to belittle
+ * their efforts and hope they will contact us to see their names
+ * properly added to the Copyright notice above.
+ * Having published their contributions under the terms of the GNU
+ * General Public License (GPL) [version 2], the Copyright of these
+ * authors will remain respected by adhering to the license they chose
+ * to publish their code under.
+ */
+
+#include <gammu-config.h>
+
+#ifdef GSM_ENABLE_NOKIA6510
+
+#include <string.h>
+#include <time.h>
+#ifdef HAVE_STDINT_H
+#include <stdint.h>
+#endif
+
+#include <gammu-nokia.h>
+
+#include "../../../../misc/coding/coding.h"
+#include "../../../../misc/locales.h"
+#include "../../../../gsmcomon.h"
+#include "../../../../service/gsmlogo.h"
+#include "../../../../service/gsmnet.h"
+#include "../../../../service/gsmring.h"
+#include "../../../../service/sms/gsmmulti.h"
+#include "../../nfunc.h"
+#include "../../nfuncold.h"
+#include "../../../pfunc.h"
+#include "../dct4func.h"
+#include "n6510.h"
+#include "6510cal.h"
+#include "6510file.h"
+
+static GSM_Error N6510_Initialise (GSM_StateMachine *s)
+{
+ s->Phone.Data.Priv.N6510.CalendarIconsNum = 0;
+ s->Phone.Data.Priv.N6510.LastFreeMemoryLocation = 0;
+ s->Phone.Data.Priv.N6510.LastFreeMemoryType = 0;
+ s->Phone.Data.Priv.N6510.FilesLocationsAvail = 0;
+ s->Phone.Data.Priv.N6510.FilesLocationsUsed = 0;
+ s->Phone.Data.Priv.N6510.FilesCache = NULL;
+ s->Phone.Data.Priv.N6510.ScreenWidth = 0;
+ s->Phone.Data.Priv.N6510.ScreenHeight = 0;
+
+ /* Default timeout for cables */
+ s->Phone.Data.Priv.N6510.Timeout = 8;
+ if (s->ConnectionType == GCT_IRDAPHONET || s->ConnectionType == GCT_FBUS2IRDA) {
+ s->Phone.Data.Priv.N6510.Timeout = 40;
+ }
+ if (s->ConnectionType == GCT_BLUEPHONET || s->ConnectionType == GCT_BLUEFBUS2) {
+ s->Phone.Data.Priv.N6510.Timeout = 20;
+ }
+
+ /* Enables various things like incoming SMS, call info, etc. */
+ return N71_65_EnableFunctions (s, "\x01\x02\x06\x0A\x14\x17\x39", 7);
+}
+
+static GSM_Error N6510_Terminate (GSM_StateMachine *s)
+{
+ free(s->Phone.Data.Priv.N6510.FilesCache);
+ s->Phone.Data.Priv.N6510.FilesCache = NULL;
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_ReplyGetMemory(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Phonebook entry received\n");
+ if (msg->Buffer[6] == 0x0f)
+ return N71_65_ReplyGetMemoryError(msg->Buffer[10], s);
+
+ if (msg->Length < 22) {
+ return ERR_UNKNOWN;
+ }
+ return N71_65_DecodePhonebook(s,
+ s->Phone.Data.Memory,
+ s->Phone.Data.Bitmap,
+ s->Phone.Data.SpeedDial,
+ msg->Buffer + 22,
+ msg->Length - 22,
+ FALSE);
+}
+
+static GSM_Error N6510_GetMemory (GSM_StateMachine *s, GSM_MemoryEntry *entry)
+{
+ GSM_Error error;
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x07, 0x01, 0x01, 0x00, 0x01,
+ 0xfe, 0x10, /* memory type */
+ 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x01, /* location */
+ 0x00, 0x00, 0x01};
+
+ req[9] = NOKIA_GetMemoryType(s, entry->MemoryType,N71_65_MEMORY_TYPES);
+ if (req[9]==0xff) return ERR_NOTSUPPORTED;
+
+ if (entry->Location==0x00) return ERR_INVALIDLOCATION;
+
+ req[14] = entry->Location / 256;
+ req[15] = entry->Location % 256;
+
+ s->Phone.Data.Memory=entry;
+ smprintf(s, "Getting phonebook entry\n");
+ error = GSM_WaitFor (s, req, 19, 0x03, s->Phone.Data.Priv.N6510.Timeout, ID_GetMemory);
+ if (error == ERR_WORKINPROGRESS) {
+ sleep(2);
+ smprintf(s, "Retrying to get phonebook entry\n");
+ error = GSM_WaitFor (s, req, 19, 0x03, s->Phone.Data.Priv.N6510.Timeout, ID_GetMemory);
+ }
+ if (entry->MemoryType == MEM_DC || entry->MemoryType == MEM_RC || entry->MemoryType == MEM_MC) {
+ /* 6111 */
+ if (error == ERR_NOTSUPPORTED) return ERR_EMPTY;
+ }
+ return error;
+}
+
+static GSM_Error N6510_ReplyGetMemoryStatus(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Memory status received\n");
+ /* Quess ;-)) */
+ if (msg->Buffer[14]==0x10) {
+ Data->MemoryStatus->MemoryFree = msg->Buffer[18]*256 + msg->Buffer[19];
+ Data->MemoryStatus->MemoryUsed = msg->Buffer[20]*256 + msg->Buffer[21];
+ } else if (msg->Buffer[14]==0x02) {
+ Data->MemoryStatus->MemoryFree = msg->Buffer[22];
+ Data->MemoryStatus->MemoryUsed = msg->Buffer[21];
+ } else {
+ Data->MemoryStatus->MemoryFree = msg->Buffer[17];
+ Data->MemoryStatus->MemoryUsed = msg->Buffer[20]*256 + msg->Buffer[21];
+ }
+ smprintf(s, "Size : %i\n",Data->MemoryStatus->MemoryFree);
+ smprintf(s, "Used : %i\n",Data->MemoryStatus->MemoryUsed);
+ Data->MemoryStatus->MemoryFree -= Data->MemoryStatus->MemoryUsed;
+ smprintf(s, "Free : %i\n",Data->MemoryStatus->MemoryFree);
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetMemoryStatus(GSM_StateMachine *s, GSM_MemoryStatus *Status)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x03, 0x02,
+ 0x00, /* memory type */
+ 0x55, 0x55, 0x55, 0x00};
+
+ req[5] = NOKIA_GetMemoryType(s, Status->MemoryType,N71_65_MEMORY_TYPES);
+ if (req[5]==0xff) return ERR_NOTSUPPORTED;
+
+ s->Phone.Data.MemoryStatus=Status;
+ smprintf(s, "Getting memory status\n");
+ return GSM_WaitFor (s, req, 10, 0x03, s->Phone.Data.Priv.N6510.Timeout, ID_GetMemoryStatus);
+}
+
+static GSM_Error N6510_ReplyGetSMSC(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int i, current, j;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ size_t pos;
+ GSM_Error error;
+
+ switch (msg->Buffer[4]) {
+ case 0x00:
+ smprintf(s, "SMSC received\n");
+ break;
+ case 0x02:
+ smprintf(s, "SMSC empty\n");
+ return ERR_INVALIDLOCATION;
+ case 0x09:
+ smprintf(s, "SMSC empty???\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "Unknown SMSC state: %02x\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ memset(Data->SMSC,0,sizeof(GSM_SMSC));
+ Data->SMSC->Location = msg->Buffer[8];
+ Data->SMSC->Format = SMS_FORMAT_Text;
+ switch (msg->Buffer[10]) {
+ case 0x00: Data->SMSC->Format = SMS_FORMAT_Text; break;
+ case 0x22: Data->SMSC->Format = SMS_FORMAT_Fax; break;
+ case 0x26: Data->SMSC->Format = SMS_FORMAT_Pager; break;
+ case 0x32: Data->SMSC->Format = SMS_FORMAT_Email; break;
+ }
+ Data->SMSC->Validity.Format = SMS_Validity_RelativeFormat;
+ Data->SMSC->Validity.Relative = msg->Buffer[12];
+ if (msg->Buffer[12] == 0x00) Data->SMSC->Validity.Relative = SMS_VALID_Max_Time;
+
+ current = 14;
+ for (i=0;i<msg->Buffer[13];i++) {
+ switch (msg->Buffer[current]) {
+ case 0x81:
+ j=current+4;
+ while (msg->Buffer[j]!=0) {j++;}
+ j=j-33;
+ if (j>GSM_MAX_SMSC_NAME_LENGTH) {
+ smprintf(s, "Too long name\n");
+ return ERR_UNKNOWNRESPONSE;
+ }
+ CopyUnicodeString(Data->SMSC->Name,msg->Buffer+current+4);
+ smprintf(s, " Name \"%s\"\n", DecodeUnicodeString(Data->SMSC->Name));
+ break;
+ case 0x82:
+ switch (msg->Buffer[current+2]) {
+ case 0x01:
+ pos = current + 4;
+ error = GSM_UnpackSemiOctetNumber(&(s->di), Data->SMSC->DefaultNumber, msg->Buffer, &pos, msg->Length, TRUE);
+ if (error != ERR_NONE) {
+ return error;
+ }
+ smprintf(s, " Default number \"%s\"\n", DecodeUnicodeString(Data->SMSC->DefaultNumber));
+ break;
+ case 0x02:
+ pos = current + 4;
+ error = GSM_UnpackSemiOctetNumber(&(s->di), Data->SMSC->Number, msg->Buffer, &pos, msg->Length, FALSE);
+ if (error != ERR_NONE) {
+ return error;
+ }
+ smprintf(s, " Number \"%s\"\n", DecodeUnicodeString(Data->SMSC->Number));
+ break;
+ default:
+ smprintf(s, "Unknown SMSC number: %02x\n",msg->Buffer[current+2]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ break;
+ default:
+ smprintf(s, "Unknown SMSC block: %02x\n",msg->Buffer[current]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ current = current + msg->Buffer[current+1];
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetSMSC(GSM_StateMachine *s, GSM_SMSC *smsc)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x14,
+ 0x01, /* location */
+ 0x00};
+
+ if (smsc->Location==0x00) return ERR_INVALIDLOCATION;
+
+ req[4]=smsc->Location;
+
+ s->Phone.Data.SMSC=smsc;
+ smprintf(s, "Getting SMSC\n");
+ return GSM_WaitFor (s, req, 6, 0x02, s->Phone.Data.Priv.N6510.Timeout, ID_GetSMSC);
+}
+
+static GSM_Error N6510_ReplySetSMSC(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[4]) {
+ case 0x00:
+ smprintf(s, "SMSC set OK\n");
+ return ERR_NONE;
+ case 0x02:
+ smprintf(s, "Invalid SMSC location\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "Unknown SMSC state: %02x\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+}
+
+static GSM_Error N6510_SetSMSC(GSM_StateMachine *s, GSM_SMSC *smsc)
+{
+ int count = 13,i;
+ unsigned char req[256] = {N6110_FRAME_HEADER,
+ 0x12, 0x55, 0x01, 0x0B, 0x34,
+ 0x05, /* Location */
+ 0x00,
+ 0x00, /* Format */
+ 0x00,
+ 0xFF}; /* Validity */
+
+ req[8] = smsc->Location;
+ switch (smsc->Format) {
+ case SMS_FORMAT_Text: req[10] = 0x00; break;
+ case SMS_FORMAT_Fax: req[10] = 0x22; break;
+ case SMS_FORMAT_Pager: req[10] = 0x26; break;
+ case SMS_FORMAT_Email: req[10] = 0x32; break;
+ }
+ req[12] = smsc->Validity.Relative;
+
+ /* We have now blocks. Number of blocks = 3 */
+ req[count++] = 0x03;
+
+ /* -------------- SMSC number ----------------- */
+ /* Block type: number */
+ req[count++] = 0x82;
+ /* Offset to next block */
+ req[count++] = 0x1A;
+ /* Type of number: SMSC number */
+ req[count++] = 0x02;
+ req[count] = GSM_PackSemiOctetNumber(smsc->Number, req+count+2, FALSE) + 1;
+ if (req[count]>18) {
+ smprintf(s, "Too long SMSC number in frame\n");
+ return ERR_UNKNOWN;
+ }
+ req[count+1] = req[count] - 1;
+ count += 23;
+
+ /* --------------- Default number ------------- */
+ /* Block type: number */
+ req[count++] = 0x82;
+ /* Offset to next block */
+ req[count++] = 0x14;
+ /* Type of number: default number */
+ req[count++] = 0x01;
+ req[count] = GSM_PackSemiOctetNumber(smsc->DefaultNumber, req+count+2, TRUE) + 1;
+ if (req[count]*2>12) {
+ smprintf(s, "Too long SMSC number in frame\n");
+ return ERR_UNKNOWN;
+ }
+ req[count+1] = req[count] - 1;
+ count += 17;
+
+ /* -------------- SMSC name ------------------- */
+ req[count++] = 0x81;
+ req[count++] = UnicodeLength(smsc->Name)*2 + 2 + 4;
+ req[count++] = UnicodeLength(smsc->Name)*2 + 2;
+ req[count++] = 0x00;
+ /* Can't make CopyUnicodeString(req+count,sms->Name) !!!!
+ * with MSVC6 count is changed then
+ */
+ i = count;
+ CopyUnicodeString(req+i,smsc->Name);
+ count += UnicodeLength(smsc->Name)*2 + 2;
+
+ smprintf(s, "Setting SMSC\n");
+ return GSM_WaitFor (s, req, count, 0x02, s->Phone.Data.Priv.N6510.Timeout, ID_SetSMSC);
+}
+
+static GSM_Error N6510_ReplyGetNetworkInfo(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int current = msg->Buffer[7]+7, pos;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ GSM_NetworkInfo network_info_local, *network_info;
+
+ if (msg->Buffer[3] == 0xf0) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ if (Data->RequestID == ID_GetNetworkInfo) {
+ network_info = Data->NetworkInfo;
+ } else {
+ network_info = &network_info_local;
+ }
+
+ network_info->NetworkName[0] = 0x00;
+ network_info->NetworkName[1] = 0x00;
+
+ switch (msg->Buffer[8]) {
+ case 0x00:
+ smprintf(s, "home network\n");
+ network_info->State = GSM_HomeNetwork;
+ break;
+ case 0x01:
+ smprintf(s, "roaming network\n");
+ network_info->State = GSM_RoamingNetwork;
+ break;
+ case 0x04:
+ smprintf(s, "not logged");
+ network_info->State = GSM_NoNetwork;
+ break;
+ case 0x06:
+ smprintf(s, "SIM card rejected\n");
+ network_info->State = GSM_RegistrationDenied;
+ break;
+ case 0x09:
+ smprintf(s, "not logged");
+ network_info->State = GSM_NoNetwork;
+ break;
+ default:
+ smprintf(s, "unknown %i!\n",msg->Buffer[8]);
+ network_info->State = GSM_NetworkStatusUnknown;
+ }
+ if (network_info->State == GSM_HomeNetwork || network_info->State == GSM_RoamingNetwork) {
+ pos = 10;
+ NOKIA_GetUnicodeString(s, &pos, msg->Buffer, network_info->NetworkName, TRUE);
+ smprintf(s, "Network name: %s ", DecodeUnicodeString(network_info->NetworkName));
+ NOKIA_DecodeNetworkCode(msg->Buffer + (current + 7), network_info->NetworkCode);
+ smprintf(s, "Network code: %s\n", network_info->NetworkCode);
+ smprintf(s, "Network name in libGammu: %s ", DecodeUnicodeString(GSM_GetNetworkName(network_info->NetworkCode)));
+ sprintf(network_info->LAC, "%02X%02X", msg->Buffer[current+1], msg->Buffer[current+2]);
+ smprintf(s, "LAC: %s\n", network_info->LAC);
+ sprintf(network_info->CID, "%02X%02X", msg->Buffer[current+5], msg->Buffer[current+6]);
+ smprintf(s, "CID: %s\n", network_info->CID);
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetNetworkInfo(GSM_StateMachine *s, GSM_NetworkInfo *netinfo)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x00, 0x00};
+
+ netinfo->GPRS = 0;
+ s->Phone.Data.NetworkInfo=netinfo;
+ smprintf(s, "Getting network info\n");
+ return GSM_WaitFor (s, req, 5, 0x0a, s->Phone.Data.Priv.N6510.Timeout, ID_GetNetworkInfo);
+}
+
+static GSM_Error N6510_EncodeSMSFrame(GSM_StateMachine *s, GSM_SMSMessage *sms, unsigned char *req, GSM_SMSMessageLayout *Layout, int *length)
+{
+ int count = 0, pos1, pos2, pos3, pos4, pos5;
+ GSM_Error error;
+
+ memset(Layout,255,sizeof(GSM_SMSMessageLayout));
+
+ req[count++] = 0x01;
+ if (sms->PDU != SMS_Deliver) {
+ req[count++] = 0x02;
+ } else {
+ req[count++] = 0x00;
+ }
+
+ pos1 = count; count++;
+ /* firstbyte set in SMS Layout */
+ Layout->firstbyte = count; count++;
+ if (sms->PDU != SMS_Deliver) {
+ Layout->TPMR = count; count++;
+
+ Layout->TPPID = count; count++;
+
+ /* TP.DCS set in SMS layout */
+ Layout->TPDCS = count; count++;
+ req[count++] = 0x00;
+ } else {
+ Layout->TPPID = count; count++;
+ /* TP.DCS set in SMS layout */
+ Layout->TPDCS = count; count++;
+ Layout->DateTime = count; count += 7;
+ req[count++] = 0x55;
+ req[count++] = 0x55;
+ req[count++] = 0x55;
+ }
+
+ /* We have now blocks. Number of blocks = 3 or 4 */
+ if (sms->PDU != SMS_Deliver) {
+ req[count++] = 0x04;
+ } else {
+ req[count++] = 0x03;
+ }
+
+ /* -------------- Phone number ------------- */
+ /* Block type: number */
+ req[count++] = 0x82;
+ /* Offset to next block */
+ req[count++] = 0x10;
+ /* Type of number: default number */
+ req[count++] = 0x01;
+ pos4 = count; count++;
+ /* now coded Number in SMS Layout */
+ Layout->Number = count; count+= 12;
+
+ /* -------------- SMSC number -------------- */
+ /* Block type: number */
+ req[count++] = 0x82;
+ /* Offset to next block */
+ req[count++] = 0x10;
+ /* Type of number: SMSC number */
+ req[count++] = 0x02;
+ pos5 = count; count++;
+ /* now coded SMSC number in SMS Layout */
+ Layout->SMSCNumber = count; count += 12;
+
+ /* -------------- SMS validity ------------- */
+ if (sms->PDU != SMS_Deliver) {
+ /* Block type: validity */
+ req[count++] = 0x08;
+ req[count++] = 0x04;
+ /* data length */
+ req[count++] = 0x01;
+ Layout->TPVP = count; count++;
+ }
+
+ /* --------------- SMS text ---------------- */
+ /* Block type: SMS text */
+ req[count++] = 0x80;
+ /* this the same as req[11] but starting from req[42] */
+ pos2 = count; count++;
+ pos3 = count; count++;
+ /* FIXME*/
+ Layout->TPUDL = count; count++;
+ /* SMS text and UDH coded in SMS Layout */
+ Layout->Text = count;
+
+ error = PHONE_EncodeSMSFrame(s,sms,req,*Layout,length,FALSE);
+ if (error != ERR_NONE) return error;
+
+ req[pos1] = *length - 1;
+ req[pos2] = *length - Layout->Text + 6;
+ req[pos3] = *length - Layout->Text;
+
+ /* Convert number of semioctets to number of chars */
+ req[pos4] = req[Layout->Number] + 4;
+ if (req[pos4] % 2) req[pos4]++;
+ req[pos4] /= 2;
+
+ req[pos5] = req[Layout->SMSCNumber] + 1;
+
+ if (req[pos4]>12 || req[pos5]>12) {
+ smprintf(s, "Too long phone number in frame\n");
+ return ERR_UNKNOWN;
+ }
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_ReplyGetSMSFolders(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int j, num = 0;
+ size_t pos;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg->Buffer[3]) {
+ case 0x13:
+ smprintf(s, "SMS folders names received\n");
+ Data->SMSFolders->Number = msg->Buffer[5]+2;
+ pos = 6;
+ for (j=0;j<msg->Buffer[5];j++) {
+ while (TRUE) {
+ if (msg->Buffer[pos] == msg->Buffer[6] &&
+ msg->Buffer[pos+1] == msg->Buffer[7]) break;
+ if (pos+4 > msg->Length) return ERR_UNKNOWNRESPONSE;
+ pos++;
+ }
+ pos+=4;
+ smprintf(s, "Folder index: %02x",msg->Buffer[pos - 2]);
+ if (msg->Buffer[pos - 1]>GSM_MAX_SMS_FOLDER_NAME_LEN) {
+ smprintf(s, "Too long text\n");
+ return ERR_UNKNOWNRESPONSE;
+ }
+ CopyUnicodeString(Data->SMSFolders->Folder[num].Name,msg->Buffer + pos);
+ smprintf(s, ", folder name: \"%s\"\n",DecodeUnicodeString(Data->SMSFolders->Folder[num].Name));
+ Data->SMSFolders->Folder[num].InboxFolder = FALSE;
+ Data->SMSFolders->Folder[num].Memory = MEM_ME;
+ if (num == 0x01) { /* OUTBOX SIM */
+ Data->SMSFolders->Folder[0].Memory = MEM_SM;
+ Data->SMSFolders->Folder[0].InboxFolder = TRUE;
+ Data->SMSFolders->Folder[0].OutboxFolder = FALSE;
+
+ Data->SMSFolders->Folder[1].Memory = MEM_SM;
+ Data->SMSFolders->Folder[1].InboxFolder = FALSE;
+ Data->SMSFolders->Folder[1].OutboxFolder = TRUE;
+
+ CopyUnicodeString(Data->SMSFolders->Folder[2].Name,Data->SMSFolders->Folder[0].Name);
+ Data->SMSFolders->Folder[2].Memory = MEM_ME;
+ Data->SMSFolders->Folder[2].InboxFolder = TRUE;
+ Data->SMSFolders->Folder[2].OutboxFolder = FALSE;
+
+ CopyUnicodeString(Data->SMSFolders->Folder[3].Name,Data->SMSFolders->Folder[1].Name);
+ Data->SMSFolders->Folder[3].Memory = MEM_ME;
+ Data->SMSFolders->Folder[3].InboxFolder = FALSE;
+ Data->SMSFolders->Folder[3].OutboxFolder = TRUE;
+
+ num+=2;
+ }
+ num++;
+ }
+ return ERR_NONE;
+ case 0xf0:
+ smprintf(s, "HINT: Maybe phone needs F_SMS_FILES?\n");
+ break;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+GSM_Error N6510_GetSMSFoldersS40_30(GSM_StateMachine *s UNUSED, GSM_SMSFolders *folders)
+{
+ folders->Number=4;
+ EncodeUnicode(folders->Folder[0].Name,_("SIM"),strlen(_("SIM")));
+ EncodeUnicode(folders->Folder[1].Name,_("Inbox"),strlen(_("Inbox")));
+ EncodeUnicode(folders->Folder[2].Name,_("Sent items"),strlen(_("Sent items")));
+ EncodeUnicode(folders->Folder[3].Name,_("Saved items"),strlen(_("Saved items")));
+ folders->Folder[0].InboxFolder = TRUE;
+ folders->Folder[1].InboxFolder = TRUE;
+ folders->Folder[2].InboxFolder = FALSE;
+ folders->Folder[3].InboxFolder = FALSE;
+ folders->Folder[0].OutboxFolder = TRUE;
+ folders->Folder[1].OutboxFolder = FALSE;
+ folders->Folder[2].OutboxFolder = TRUE;
+ folders->Folder[3].OutboxFolder = FALSE;
+ folders->Folder[0].Memory = MEM_SM;
+ folders->Folder[1].Memory = MEM_ME;
+ folders->Folder[2].Memory = MEM_ME;
+ folders->Folder[3].Memory = MEM_ME;
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetSMSFolders(GSM_StateMachine *s, GSM_SMSFolders *folders)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x12, 0x00, 0x00};
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SMS_FILES)) return N6510_GetFilesystemSMSFolders(s,folders);
+ return N6510_GetSMSFoldersS40_30(s,folders);
+ }
+
+ s->Phone.Data.SMSFolders=folders;
+ smprintf(s, "Getting SMS folders\n");
+ return GSM_WaitFor (s, req, 6, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_GetSMSFolders);
+}
+
+static GSM_Error N6510_ReplyGetSMSFolderStatus(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int i;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+
+ smprintf(s, "SMS folder status received\n");
+ Priv->LastSMSFolder.Number=msg->Buffer[6]*256+msg->Buffer[7];
+ smprintf(s, "Number of Entries: %i\n",Priv->LastSMSFolder.Number);
+ smprintf(s, "Locations: ");
+ for (i=0;i<Priv->LastSMSFolder.Number;i++) {
+ Priv->LastSMSFolder.Location[i]=msg->Buffer[8+(i*2)]*256+msg->Buffer[(i*2)+9];
+ smprintf(s, "%i ",Priv->LastSMSFolder.Location[i]);
+ }
+ smprintf(s, "\n");
+ NOKIA_SortSMSFolderStatus(s, &Priv->LastSMSFolder);
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetSMSFolderStatus(GSM_StateMachine *s, int folderid)
+{
+ unsigned char req[] = {N7110_FRAME_HEADER, 0x0C,
+ 0x01, /* 0x01=SIM, 0x02=ME */
+ 0x00, /* Folder ID */
+ 0x0f, 0x55, 0x55, 0x55};
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ switch (folderid) {
+ case 0x01: req[5] = 0x01; break; /* SIM */
+ default : req[5] = folderid; req[4] = 0x02; break; /* ME folders */
+ }
+ } else {
+ switch (folderid) {
+ case 0x01: req[5] = 0x02; break; /* INBOX SIM */
+ case 0x02: req[5] = 0x03; break; /* OUTBOX SIM */
+ default : req[5] = folderid - 1; req[4] = 0x02; break; /* ME folders */
+ }
+ }
+
+ smprintf(s, "Getting SMS folder status\n");
+ return GSM_WaitFor (s, req, 10, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_GetSMSFolderStatus);
+}
+
+static void N6510_GetSMSLocation(GSM_StateMachine *s, GSM_SMSMessage *sms, unsigned char *folderid, unsigned int *location)
+{
+ int ifolderid;
+
+ /* simulate flat SMS memory */
+ if (sms->Folder==0x00) {
+ ifolderid = sms->Location / GSM_PHONE_MAXSMSINFOLDER;
+ *folderid = ifolderid + 0x01;
+ *location = sms->Location - ifolderid * GSM_PHONE_MAXSMSINFOLDER;
+ if (*folderid == 0x1B) (*folderid)=0x99; /* 0x1A is Outbox in 6230i */
+ } else {
+ *folderid = sms->Folder;
+ *location = sms->Location;
+ if (*folderid == 0x1A) (*folderid)=0x99; /* 0x1A is Outbox in 6230i */
+ }
+ smprintf(s, "SMS folder %i & location %i -> 6510 folder %i & location %i\n",
+ sms->Folder,sms->Location,*folderid,*location);
+}
+
+static void N6510_SetSMSLocation(GSM_StateMachine *s, GSM_SMSMessage *sms, unsigned char folderid, int location)
+{
+ sms->Folder = 0;
+ sms->Location = (folderid - 0x01) * GSM_PHONE_MAXSMSINFOLDER + location;
+ smprintf(s, "6510 folder %i & location %i -> SMS folder %i & location %i\n",
+ folderid,location,sms->Folder,sms->Location);
+}
+
+static GSM_Error N6510_DecodeSMSFrame(GSM_StateMachine *s, GSM_SMSMessage *sms, unsigned char *buffer, size_t *current2)
+{
+ int i, current, blocks=0, SMSTemplateDateTime = 0;
+ GSM_SMSMessageLayout Layout;
+ GSM_Error error;
+
+ memset(&Layout,255,sizeof(GSM_SMSMessageLayout));
+ Layout.firstbyte = 2;
+ switch (buffer[0]) {
+ case 0x00:
+ smprintf(s, "SMS deliver\n");
+ sms->PDU = SMS_Deliver;
+ Layout.TPPID = 3;
+ Layout.TPDCS = 4;
+ Layout.DateTime = 5;
+ blocks = 15;
+ break;
+ case 0x01:
+ smprintf(s, "Delivery report\n");
+ sms->PDU = SMS_Status_Report;
+ Layout.TPMR = 3;
+ Layout.TPStatus = 4;
+ Layout.DateTime = 5;
+ Layout.SMSCTime = 12;
+ blocks = 19;
+ break;
+ case 0x02:
+ smprintf(s, "SMS template\n");
+ sms->PDU = SMS_Submit;
+ Layout.TPMR = 3;
+ Layout.TPPID = 4;
+ Layout.TPDCS = 5;
+ blocks = 7;
+ break;
+ }
+ current = blocks + 1;
+ for (i=0;i<buffer[blocks];i++) {
+ switch (buffer[current]) {
+ case 0x08:
+ smprintf(s, "SMSC timestamp (ignored)\n");
+ break;
+ case 0x80:
+ smprintf(s, "SMS text\n");
+ if (buffer[current + 2] > buffer[current + 3]) {
+ Layout.TPUDL = current + 2;
+ } else {
+ Layout.TPUDL = current + 3;
+ }
+ Layout.Text = current + 4;
+ break;
+ case 0x82:
+ switch (buffer[current+2]) {
+ case 0x01:
+ smprintf(s, "Phone number\n");
+ Layout.Number = current + 4;
+ break;
+ case 0x02:
+ smprintf(s, "SMSC number\n");
+ Layout.SMSCNumber = current + 4;
+ break;
+ default:
+ smprintf(s, "Unknown number\n");
+ break;
+ }
+ break;
+ case 0x84:
+ smprintf(s, "Date and time of saving for SMS template\n");
+ SMSTemplateDateTime = current + 2;
+ break;
+ default:
+ smprintf(s, "Unknown block %02x\n",buffer[current]);
+ }
+ current = current + buffer[current + 1];
+ }
+ error = GSM_DecodeSMSFrame(&(s->di), sms,buffer,Layout);
+ if (SMSTemplateDateTime != 0) {
+ sms->PDU = SMS_Deliver;
+ NOKIA_DecodeDateTime(s, buffer+SMSTemplateDateTime, &sms->DateTime, TRUE, FALSE);
+ }
+ (*current2) = current;
+ return error;
+}
+
+GSM_Error N6510_ReplyGetSMSMessage(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ size_t i,j;
+ size_t Width, Height;
+ unsigned char output[500]; /* output2[500]; */
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ GSM_Error error;
+
+ switch(msg->Buffer[3]) {
+ case 0x03:
+ smprintf(s, "SMS Message received\n");
+ GSM_SetDefaultReceivedSMSData(Data->GetSMSMessage->SMS);
+ Data->GetSMSMessage->Number=1;
+ NOKIA_DecodeSMSState(s, msg->Buffer[5], &(Data->GetSMSMessage->SMS[0]));
+ if (msg->Length < 15) {
+ smprintf(s, "No message data!\n");
+ Data->GetSMSMessage->SMS[0].PDU = SMS_Deliver;
+ return ERR_NONE;
+ }
+ switch (msg->Buffer[14]) {
+ case 0x00:
+ case 0x01:
+ case 0x02:
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ Data->GetSMSMessage->Number=0;
+ i = 14;
+ while (TRUE) {
+ error = N6510_DecodeSMSFrame(s, &Data->GetSMSMessage->SMS[Data->GetSMSMessage->Number],msg->Buffer+i,&j);
+ if (error != ERR_NONE) return error;
+ NOKIA_DecodeSMSState(s, msg->Buffer[5], &Data->GetSMSMessage->SMS[Data->GetSMSMessage->Number]);
+ i+=j;
+ Data->GetSMSMessage->Number++;
+ if (i>=msg->Length) break;
+ }
+ return error;
+ } else {
+ return N6510_DecodeSMSFrame(s, &Data->GetSMSMessage->SMS[0],msg->Buffer+14,&j);
+ }
+ case 0xA0:
+ smprintf(s, "Picture Image\n");
+ Data->GetSMSMessage->Number = 0;
+ i = 0;
+ output[i++] = 0x30; /* Smart Messaging 3.0 */
+ output[i++] = SM30_OTA;
+ output[i++] = 0x01; /* Length */
+ output[i++] = 0x00; /* Length */
+ output[i++] = 0x00;
+ PHONE_GetBitmapWidthHeight(GSM_NokiaPictureImage, &Width, &Height);
+ output[i++] = Width;
+ output[i++] = Height;
+ output[i++] = 0x01;
+ memcpy(output+i,msg->Buffer+30,PHONE_GetBitmapSize(GSM_NokiaPictureImage,0,0));
+ i = i + PHONE_GetBitmapSize(GSM_NokiaPictureImage,0,0);
+#if 0
+ if (msg->Length!=282) {
+ output[i++] = SM30_UNICODETEXT;
+ output[i++] = 0;
+ output[i++] = 0; /* Length - later changed */
+ GSM_UnpackEightBitsToSeven(0, msg->Length-282, msg->Length-304, msg->Buffer+282,output2);
+ DecodeDefault(output+i, output2, msg->Length - 282, TRUE, NULL);
+ output[i - 1] = UnicodeLength(output+i) * 2;
+ i = i + output[i-1];
+ }
+#endif
+ GSM_MakeMultiPartSMS(&(s->di), Data->GetSMSMessage,output,i,UDH_NokiaProfileLong,SMS_Coding_8bit,1,0);
+ for (i=0;i<3;i++) {
+ Data->GetSMSMessage->SMS[i].Number[0]=0;
+ Data->GetSMSMessage->SMS[i].Number[1]=0;
+ }
+ if (Data->Bitmap != NULL) {
+ Data->Bitmap->Location = 0;
+ PHONE_GetBitmapWidthHeight(GSM_NokiaPictureImage, &Width, &Height);
+ Data->Bitmap->BitmapWidth = Width;
+ Data->Bitmap->BitmapHeight = Height;
+ PHONE_DecodeBitmap(GSM_NokiaPictureImage, msg->Buffer + 30, Data->Bitmap);
+ Data->Bitmap->Sender[0] = 0x00;
+ Data->Bitmap->Sender[1] = 0x00;
+ Data->Bitmap->Text[0] = 0;
+ Data->Bitmap->Text[1] = 0;
+ }
+ return ERR_NONE;
+ default:
+ smprintf(s, "Unknown SMS type: %i\n",msg->Buffer[8]);
+ }
+ break;
+ case 0x0f:
+ smprintf(s, "SMS message info received\n");
+ CopyUnicodeString(Data->GetSMSMessage->SMS[0].Name,msg->Buffer+52);
+ smprintf(s, "Name: \"%s\"\n",DecodeUnicodeString(Data->GetSMSMessage->SMS[0].Name));
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_PrivGetSMSMessageBitmap(GSM_StateMachine *s, GSM_MultiSMSMessage *sms, GSM_Bitmap *bitmap)
+{
+ GSM_Error error;
+ unsigned char folderid,namebuffer[200];
+ unsigned int location;
+ int i;
+ unsigned char req[] = {
+ N6110_FRAME_HEADER,
+ 0x02, /* msg type: 0x02 for getting sms, 0x0e for sms status */
+ 0x01, /* 0x01=SIM, 0x02=ME */
+ 0x00, /* FolderID */
+ 0x00, 0x02, /* Location */
+ 0x01, 0x00};
+
+ N6510_GetSMSLocation(s, &sms->SMS[0], &folderid, &location);
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ switch (folderid) {
+ case 0x01: req[5] = 0x01; break; /* SIM */
+ default : req[5] = folderid; req[4] = 0x02; break; /* ME folders */
+ }
+ } else {
+ switch (folderid) {
+ case 0x01: req[5] = 0x02; break; /* INBOX SIM */
+ case 0x02: req[5] = 0x03; break; /* OUTBOX SIM */
+ default : req[5] = folderid - 1; req[4] = 0x02; break; /* ME folders */
+ }
+ }
+
+ req[6]=location / 256;
+ req[7]=location % 256;
+
+ s->Phone.Data.GetSMSMessage = sms;
+ s->Phone.Data.Bitmap = bitmap;
+ smprintf(s, "Getting sms message info\n");
+ req[3] = 0x0e; req[8] = 0x55; req[9] = 0x55;
+ error=GSM_WaitFor (s, req, 10, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_GetSMSMessage);
+ if (error!=ERR_NONE) return error;
+ CopyUnicodeString(namebuffer,sms->SMS[0].Name);
+
+ smprintf(s, "Getting sms\n");
+ req[3] = 0x02; req[8] = 0x01; req[9] = 0x00;
+ error = GSM_WaitFor (s, req, 10, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_GetSMSMessage);
+ if (error == ERR_NONE) {
+ if (sms->Number == 0) {
+ return ERR_EMPTY;
+ }
+ for (i=0;i<sms->Number;i++) {
+ N6510_SetSMSLocation(s, &sms->SMS[i], folderid, location);
+ sms->SMS[i].Folder = folderid;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ sms->SMS[i].InboxFolder = TRUE;
+ if (folderid > 2) sms->SMS[i].InboxFolder = FALSE;
+ sms->SMS[i].Memory = MEM_ME;
+ if (folderid == 0x01) sms->SMS[i].Memory = MEM_SM;
+ } else {
+ sms->SMS[i].InboxFolder = TRUE;
+ if (folderid != 0x01 && folderid != 0x03) sms->SMS[i].InboxFolder = FALSE;
+ sms->SMS[i].Memory = MEM_ME;
+ if (folderid == 0x01 || folderid == 0x02) sms->SMS[i].Memory = MEM_SM;
+ }
+
+ CopyUnicodeString(sms->SMS[i].Name,namebuffer);
+ }
+ }
+ return error;
+}
+
+static GSM_Error N6510_GetSMSMessage(GSM_StateMachine *s, GSM_MultiSMSMessage *sms)
+{
+ GSM_Error error;
+ unsigned char folderid;
+ unsigned int location;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int i;
+ gboolean found = FALSE;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SMS_FILES)) return ERR_NOTSUPPORTED;
+ }
+
+ /* Clear SMS structure of any possible junk */
+ GSM_SetDefaultReceivedSMSData(&(sms->SMS[0]));
+
+ N6510_GetSMSLocation(s, &(sms->SMS[0]), &folderid, &location);
+ error=N6510_GetSMSFolderStatus(s, folderid);
+ if (error!=ERR_NONE) return error;
+ for (i=0;i<Priv->LastSMSFolder.Number;i++) {
+ if (Priv->LastSMSFolder.Location[i]==location) {
+ found = TRUE;
+ break;
+ }
+ }
+ if (!found) return ERR_EMPTY;
+ return N6510_PrivGetSMSMessageBitmap(s,sms,NULL);
+}
+
+static GSM_Error N6510_GetNextSMSMessageBitmap(GSM_StateMachine *s, GSM_MultiSMSMessage *sms, gboolean start, GSM_Bitmap *bitmap)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ unsigned char folderid;
+ unsigned int location;
+ GSM_Error error;
+ int i;
+ gboolean findnextfolder = FALSE;
+
+ if (start) {
+ folderid = 0x00;
+ findnextfolder = TRUE;
+ error=N6510_GetSMSFolders(s,&Priv->LastSMSFolders);
+ if (error!=ERR_NONE) return error;
+ } else {
+ N6510_GetSMSLocation(s, &(sms->SMS[0]), &folderid, &location);
+ for (i=0;i<Priv->LastSMSFolder.Number;i++) {
+ if (Priv->LastSMSFolder.Location[i]==location) break;
+ }
+ /* Is this last location in this folder ? */
+ if (i==Priv->LastSMSFolder.Number-1) {
+ findnextfolder=TRUE;
+ } else {
+ location=Priv->LastSMSFolder.Location[i+1];
+ }
+ }
+ if (findnextfolder) {
+ Priv->LastSMSFolder.Number=0;
+ while (Priv->LastSMSFolder.Number==0) {
+ folderid++;
+ /* Too high folder number */
+ if ((folderid-1)>=Priv->LastSMSFolders.Number) return ERR_EMPTY;
+ /* Get next folder status */
+ error=N6510_GetSMSFolderStatus(s, folderid);
+ if (error!=ERR_NONE) return error;
+ /* First location from this folder */
+ location=Priv->LastSMSFolder.Location[0];
+ }
+ }
+ N6510_SetSMSLocation(s, &sms->SMS[0], folderid, location);
+
+ return N6510_PrivGetSMSMessageBitmap(s, sms, bitmap);
+}
+
+static GSM_Error N6510_GetNextSMSMessage(GSM_StateMachine *s, GSM_MultiSMSMessage *sms, gboolean start)
+{
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30) &&
+ GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SMS_FILES)) {
+ return N6510_GetNextFilesystemSMS(s,sms,start);
+ }
+
+ return N6510_GetNextSMSMessageBitmap(s, sms, start, NULL);
+}
+
+static GSM_Error N6510_ReplyStartupNoteLogo(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ if (Data->RequestID == ID_GetBitmap) {
+ switch (msg->Buffer[4]) {
+ case 0x01:
+ smprintf(s, "Welcome note text received\n");
+ CopyUnicodeString(Data->Bitmap->Text,msg->Buffer+6);
+ smprintf(s, "Text is \"%s\"\n",DecodeUnicodeString(Data->Bitmap->Text));
+ return ERR_NONE;
+ case 0x10:
+ smprintf(s, "Dealer note text received\n");
+ CopyUnicodeString(Data->Bitmap->Text,msg->Buffer+6);
+ smprintf(s, "Text is \"%s\"\n",DecodeUnicodeString(Data->Bitmap->Text));
+ return ERR_NONE;
+ case 0x0f:
+ smprintf(s, "Startup logo received\n");
+ PHONE_DecodeBitmap(GSM_Nokia7110StartupLogo, msg->Buffer + 22, Data->Bitmap);
+ return ERR_NONE;
+ }
+ }
+ if (Data->RequestID == ID_SetBitmap) {
+ switch (msg->Buffer[4]) {
+ case 0x01:
+ case 0x10:
+ case 0x0f:
+ case 0x25:
+ return ERR_NONE;
+ }
+ }
+ return ERR_UNKNOWN;
+}
+
+static GSM_Error N6510_GetPictureImage(GSM_StateMachine *s, GSM_Bitmap *Bitmap, int *location)
+{
+ GSM_MultiSMSMessage sms;
+ int Number;
+ GSM_Bitmap bitmap;
+ GSM_Error error;
+
+ sms.SMS[0].Folder = 0;
+ Number = 0;
+ bitmap.Location = 255;
+ error=N6510_GetNextSMSMessageBitmap(s, &sms, TRUE, &bitmap);
+ while (error == ERR_NONE) {
+ if (bitmap.Location != 255) {
+ Number++;
+ if (Number == Bitmap->Location) {
+ bitmap.Location = Bitmap->Location;
+ memcpy(Bitmap,&bitmap,sizeof(GSM_Bitmap));
+ *location = sms.SMS[0].Location;
+ return ERR_NONE;
+ }
+ }
+ bitmap.Location = 255;
+ sms.SMS[0].Folder = 0;
+ error=N6510_GetNextSMSMessageBitmap(s, &sms, FALSE, &bitmap);
+ }
+ return ERR_INVALIDLOCATION;
+}
+
+static GSM_Error N6510_GetBitmap(GSM_StateMachine *s, GSM_Bitmap *Bitmap)
+{
+ unsigned char reqOp [] = {N6110_FRAME_HEADER, 0x23, 0x00, 0x00, 0x55, 0x55, 0x55};
+ unsigned char reqStartup[] = {N6110_FRAME_HEADER, 0x02, 0x0f};
+ unsigned char reqNote [] = {N6110_FRAME_HEADER, 0x02, 0x01, 0x00};
+ GSM_MemoryEntry pbk;
+ GSM_Error error;
+ int Location;
+
+ s->Phone.Data.Bitmap=Bitmap;
+ switch (Bitmap->Type) {
+ case GSM_StartupLogo:
+ Bitmap->BitmapWidth = 96;
+ Bitmap->BitmapHeight = 65;
+ GSM_ClearBitmap(Bitmap);
+ smprintf(s, "Getting startup logo\n");
+ return GSM_WaitFor (s, reqStartup, 5, 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_GetBitmap);
+ case GSM_DealerNote_Text:
+ reqNote[4] = 0x10;
+ smprintf(s, "Getting dealer note\n");
+ return GSM_WaitFor (s, reqNote, 6, 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_GetBitmap);
+ case GSM_WelcomeNote_Text:
+ smprintf(s, "Getting welcome note\n");
+ return GSM_WaitFor (s, reqNote, 6, 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_GetBitmap);
+ case GSM_CallerGroupLogo:
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PBK35)) return ERR_NOTSUPPORTED;
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_6230iCALLER)) {
+ pbk.MemoryType = (GSM_MemoryType)MEM6510_CG2;
+ pbk.Location = Bitmap->Location;
+ smprintf(s, "Getting caller group logo method 2\n");
+ return N6510_GetMemory(s,&pbk);
+ }
+ Bitmap->BitmapWidth = 72;
+ Bitmap->BitmapHeight = 14;
+ GSM_ClearBitmap(Bitmap);
+ pbk.MemoryType = (GSM_MemoryType)MEM7110_CG;
+ pbk.Location = Bitmap->Location;
+ smprintf(s, "Getting caller group logo\n");
+ error=N6510_GetMemory(s,&pbk);
+ if (error==ERR_NONE) NOKIA_GetDefaultCallerGroupName(Bitmap);
+ return error;
+ case GSM_OperatorLogo:
+ smprintf(s, "Getting operator logo\n");
+ return GSM_WaitFor (s, reqOp, 9, 0x0A, s->Phone.Data.Priv.N6510.Timeout, ID_GetBitmap);
+ case GSM_PictureImage:
+ return N6510_GetPictureImage(s, Bitmap, &Location);
+ default:
+ break;
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6510_ReplyGetIncSignalQuality(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Network level changed to: %i\n",msg->Buffer[4]);
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_ReplyGetSignalQuality(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Network level received: %i\n",msg->Buffer[8]);
+ Data->SignalQuality->SignalStrength = -1;
+ Data->SignalQuality->SignalPercent = ((int)msg->Buffer[8]);
+ Data->SignalQuality->BitErrorRate = -1;
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetSignalQuality(GSM_StateMachine *s, GSM_SignalQuality *sig)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x0B, 0x00, 0x02, 0x00, 0x00, 0x00};
+
+ s->Phone.Data.SignalQuality = sig;
+ smprintf(s, "Getting network level\n");
+ return GSM_WaitFor (s, req, 9, 0x0a, s->Phone.Data.Priv.N6510.Timeout * 3, ID_GetSignalQuality);
+}
+
+static GSM_Error N6510_IncomingBatteryCharge(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Incoming battery level received???: %i\n",
+ msg->Buffer[9]*100/7);
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_ReplyGetBatteryCharge(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ Data->BatteryCharge->BatteryPercent = ((int)(msg->Buffer[9]*100/msg->Buffer[8]));
+ Data->BatteryCharge->ChargeState = 0;
+
+ smprintf(s, "Battery level received: %i\n",
+ Data->BatteryCharge->BatteryPercent);
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetBatteryCharge(GSM_StateMachine *s, GSM_BatteryCharge *bat)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x0A, 0x02, 0x00};
+
+ GSM_ClearBatteryCharge(bat);
+ s->Phone.Data.BatteryCharge = bat;
+ smprintf(s, "Getting battery level\n");
+ return GSM_WaitFor (s, req, 6, 0x17, s->Phone.Data.Priv.N6510.Timeout, ID_GetBatteryCharge);
+}
+
+static GSM_Error N6510_ReplyGetWAPBookmark(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ return DCT3DCT4_ReplyGetWAPBookmark (msg, s, TRUE);
+}
+
+static GSM_Error N6510_ReplyGetOperatorLogo(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ if (msg->Buffer[3] == 0xf0) return ERR_NOTSUPPORTED;
+
+ smprintf(s, "Operator logo received\n");
+ if (msg->Length <= 18) {
+ smprintf(s, "Packet too short to contain operator logo\n");
+ return ERR_EMPTY;
+ }
+ NOKIA_DecodeNetworkCode(msg->Buffer+12,Data->Bitmap->NetworkCode);
+ smprintf(s, "Network code %s\n",Data->Bitmap->NetworkCode);
+ Data->Bitmap->BitmapWidth = msg->Buffer[20];
+ Data->Bitmap->BitmapHeight = msg->Buffer[21];
+ PHONE_DecodeBitmap(GSM_Nokia6510OperatorLogo,msg->Buffer+26,Data->Bitmap);
+ return ERR_NONE;
+}
+
+GSM_Error N6510_ReplyDeleteMemory(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ if (msg->Buffer[5] == 0x1) {
+ switch (msg->Buffer[6]) {
+ case 0x0f:
+ switch (msg->Buffer[10]) {
+ case 0x21:
+ smprintf(s, "Still busy processing the last command\n");
+ return ERR_BUSY;
+ case 0x3B:
+ smprintf(s, "Nothing to delete\n");
+ return ERR_NONE;
+ case 0x33:
+ smprintf(s, "Entry is read only\n");
+ return ERR_READ_ONLY;
+ default:
+ smprintf(s, "ERROR: unknown 0x%x\n", msg->Buffer[10]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ }
+ }
+ smprintf(s, "Phonebook entry deleted\n");
+ return ERR_NONE;
+}
+
+GSM_Error N6510_DeleteMemory(GSM_StateMachine *s, GSM_MemoryEntry *entry)
+{
+ unsigned char req[] = {N7110_FRAME_HEADER, 0x0f, 0x55, 0x01,
+ 0x04, 0x55, 0x00, 0x10, 0xFF, 0x02,
+ 0x00, 0x01, /* location */
+ 0x00, 0x00, 0x00, 0x00,
+ 0x05, /* memory type */
+ 0x55, 0x55, 0x55};
+
+ req[12] = entry->Location / 256;
+ req[13] = entry->Location % 256;
+
+ req[18] = NOKIA_GetMemoryType(s, entry->MemoryType,N71_65_MEMORY_TYPES);
+ if (req[18]==0xff) return ERR_NOTSUPPORTED;
+
+ smprintf(s, "Deleting phonebook entry\n");
+ return GSM_WaitFor (s, req, 22, 0x03, s->Phone.Data.Priv.N6510.Timeout, ID_SetMemory);
+}
+
+static GSM_Error N6510_SetMemory(GSM_StateMachine *s, GSM_MemoryEntry *entry)
+{
+ int count = 22;
+ size_t blocks;
+ unsigned char req[5000] = {
+ N7110_FRAME_HEADER, 0x0b, 0x00, 0x01, 0x01, 0x00, 0x00, 0x10, 0x02,
+ 0x00, /* memory type */
+ 0x00, 0x00, /* location */
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00}; /* Number of blocks */
+ GSM_Error error;
+ GSM_MemoryEntry tmp;
+ GSM_MemoryStatus status;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+
+ if (entry->Location == 0) {
+ /*
+ * We want to remember last location so that we don't check the
+ * same place again and again.
+ */
+ if (Priv->LastFreeMemoryType != entry->MemoryType) {
+ Priv->LastFreeMemoryLocation = 0;
+ Priv->LastFreeMemoryType = entry->MemoryType;
+ status.MemoryType = entry->MemoryType;
+ error = N6510_GetMemoryStatus(s, &status);
+ if (error != ERR_NONE) return error;
+ Priv->LastFreeMemorySize = status.MemoryUsed + status.MemoryFree;
+ }
+
+ /* Advance beyond last used location */
+ tmp.MemoryType = entry->MemoryType;
+ error = ERR_NONE;
+ for (tmp.Location = Priv->LastFreeMemoryLocation + 1;
+ tmp.Location < Priv->LastFreeMemorySize;
+ tmp.Location++) {
+ error = N6510_GetMemory(s, &tmp);
+ if (error != ERR_NONE) break;
+ }
+ if (error == ERR_NONE) {
+ /* Memory full */
+ return ERR_FULL;
+ } else if (error != ERR_EMPTY) {
+ /* Other failure */
+ return error;
+ }
+ /* We've got the location */
+ entry->Location = tmp.Location;
+ smprintf(s, "Found empty location: %d\n", entry->Location);
+ }
+
+ req[11] = NOKIA_GetMemoryType(s, entry->MemoryType,N71_65_MEMORY_TYPES);
+ if (req[11]==0xff) return ERR_NOTSUPPORTED;
+
+ req[12] = entry->Location / 256;
+ req[13] = entry->Location % 256;
+
+ count = count + N71_65_EncodePhonebookFrame(s, req+22, entry, &blocks, TRUE, GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_VOICETAGS));
+ req[21] = blocks;
+
+ smprintf(s, "Writing phonebook entry\n");
+ return GSM_WaitFor (s, req, count, 0x03, s->Phone.Data.Priv.N6510.Timeout, ID_SetMemory);
+}
+
+static GSM_Error N6510_AddMemory(GSM_StateMachine *s, GSM_MemoryEntry *entry)
+{
+ entry->Location = 0;
+ return N6510_SetMemory(s, entry);
+}
+
+static GSM_Error N6510_ReplySetOperatorLogo(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Operator logo set OK\n");
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_SetCallerLogo(GSM_StateMachine *s, GSM_Bitmap *bitmap)
+{
+ char string[500];
+ int block=0, i;
+ size_t Width, Height;
+ unsigned int count = 22;
+ unsigned char req[500] = {
+ N6110_FRAME_HEADER, 0x0b, 0x00, 0x01, 0x01, 0x00, 0x00, 0x10,
+ 0xfe, 0x00, /* memory type */
+ 0x00, 0x00, /* location */
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
+
+ /* Set memory type */
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_6230iCALLER)) {
+ req[11] = MEM6510_CG2;
+ } else {
+ req[11] = MEM7110_CG;
+ }
+
+ req[13] = bitmap->Location;
+
+ /* Enabling/disabling logo */
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_6230iCALLER)) {
+ string[0] = bitmap->BitmapEnabled?1:0;
+ string[1] = 0;
+ count += N71_65_PackPBKBlock(s, N7110_PBK_LOGOON, 2, block++, string, req + count);
+ }
+
+ /* Ringtone */
+ if (!bitmap->DefaultRingtone) {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_6230iCALLER)) {
+ string[0] = 0x00;
+ string[1] = 0x00;
+ string[2] = 0x00;
+ string[3] = 0x10;
+ string[4] = 0x00;
+ string[5] = 0x00;
+ string[6] = bitmap->RingtoneID;
+ string[7] = 0x00;
+ string[8] = 0x00;
+ string[9] = 0x00;
+ count += N71_65_PackPBKBlock(s, N6510_PBK_RINGTONEFILE_ID, 10, block++, string, req + count);
+ req[count - 1] = 0x01;
+ } else if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PBKTONEGAL)) {
+ /* do nothing ? */
+ } else {
+ string[0] = 0x00;
+ string[1] = 0x00;
+ string[2] = bitmap->RingtoneID;
+ count += N71_65_PackPBKBlock(s, N7110_PBK_RINGTONE_ID, 3, block++, string, req + count);
+ count --;
+ req[count-5] = 8;
+ }
+ }
+
+ /* Number of group */
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_6230iCALLER)) {
+ string[0] = bitmap->Location;
+ string[1] = 0;
+ count += N71_65_PackPBKBlock(s, N7110_PBK_GROUP, 2, block++, string, req + count);
+ }
+
+ /* Name */
+ if (!bitmap->DefaultName) {
+ i = UnicodeLength(bitmap->Text) * 2;
+ string[0] = i + 2;
+ memcpy(string + 1, bitmap->Text, i);
+ string[i + 1] = 0;
+ count += N71_65_PackPBKBlock(s, N7110_PBK_NAME, i + 2, block++, string, req + count);
+ }
+
+ /* Logo */
+ if (!bitmap->DefaultBitmap) {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_6230iCALLER)) {
+ /* write N6510_PBK_PICTURE_ID ? */
+ } else {
+ PHONE_GetBitmapWidthHeight(GSM_NokiaCallerLogo, &Width, &Height);
+ string[0] = Width;
+ string[1] = Height;
+ string[2] = 0;
+ string[3] = 0;
+ string[4] = PHONE_GetBitmapSize(GSM_NokiaCallerLogo,0,0);
+ PHONE_EncodeBitmap(GSM_NokiaCallerLogo, string + 5, bitmap);
+ count += N71_65_PackPBKBlock(s, N7110_PBK_GROUPLOGO, PHONE_GetBitmapSize(GSM_NokiaCallerLogo,0,0) + 5, block++, string, req + count);
+ }
+ }
+
+ req[21] = block;
+
+ return GSM_WaitFor (s, req, count, 0x03, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+}
+
+static GSM_Error N6510_ReplySetPicture(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Picture Image written OK, folder %i, location %i\n",msg->Buffer[4],msg->Buffer[5]*256+msg->Buffer[6]);
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_SetBitmap(GSM_StateMachine *s, GSM_Bitmap *Bitmap)
+{
+ GSM_SMSMessage sms;
+ GSM_Phone_Bitmap_Types Type;
+ size_t Width, Height, i, count;
+ unsigned char folderid;
+ unsigned int location;
+ GSM_NetworkInfo NetInfo;
+ GSM_Error error;
+ unsigned char reqStartup[1000] = {
+ N7110_FRAME_HEADER, 0x04, 0x0F,
+ 0x00, 0x00, 0x00,
+ 0x04, 0xC0, 0x02, 0x00,
+ 0x41, 0xC0, 0x03, 0x00,
+ 0x60, 0xC0, 0x04};
+ unsigned char reqColourWallPaper[200] = {
+ N6110_FRAME_HEADER, 0x07, 0x00, 0x00, 0x00, 0xD5,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x01, 0x00,
+ 0x18}; /* Bitmap ID */
+ unsigned char reqColourStartup[200] = {
+ N6110_FRAME_HEADER, 0x04, 0x25, 0x00, 0x01, 0x00, 0x18};
+ unsigned char reqOp[1000] = {
+ N7110_FRAME_HEADER, 0x25, 0x01,
+ 0x55, 0x00, 0x00, 0x55,
+ 0x01, /* 0x01 - not set, 0x02 - set */
+ 0x0C, 0x08,
+ 0x62, 0xF0, 0x10, /* Network code */
+ 0x03, 0x55, 0x55};
+ unsigned char reqColourOp[200] = {
+ N6110_FRAME_HEADER,
+ 0x07, 0x00, 0x00, 0x00, 0xE7, 0x00, 0x00, 0x00, 0xF9, 0x00,
+ 0x08, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x01, 0x00,
+ 0x18, /* File ID */
+ 0x00,
+ 0x00, 0x00, 0x00}; /* Network code */
+ unsigned char reqNote[200] = {N6110_FRAME_HEADER, 0x04, 0x01};
+ unsigned char reqPicture[2000] = {
+ N6110_FRAME_HEADER, 0x00,
+ 0x02, 0x05, /* SMS folder */
+ 0x00, 0x00, /* location */
+ 0x01, 0x01, 0xa0, 0x02, 0x01, 0x40, 0x00, 0x34,
+ 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x55, 0x55, 0x55, 0x03, 0x82, 0x10,
+ 0x01, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x82, 0x10,
+ 0x02, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x04,
+ 0x00, 0x00, 0xa1, 0x55, 0x01, 0x08, 0x00, 0x00,
+ 0x00, 0x01, 0x48, 0x1c, 0x00, 0xfc, 0x00};
+
+ switch (Bitmap->Type) {
+ case GSM_ColourWallPaper_ID:
+ reqColourWallPaper[21] = Bitmap->ID;
+ smprintf(s, "Setting colour wall paper\n");
+ return GSM_WaitFor (s, reqColourWallPaper, 22, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ case GSM_StartupLogo:
+ Type = GSM_Nokia7110StartupLogo;
+ switch (Bitmap->Location) {
+ case 1: PHONE_EncodeBitmap(Type, reqStartup + 22, Bitmap);
+ break;
+ case 2: memset(reqStartup+5,0x00,15);
+ PHONE_ClearBitmap(Type, reqStartup + 22,0,0);
+ break;
+ default: return ERR_NOTSUPPORTED;
+ }
+ smprintf(s, "Setting startup logo\n");
+ return GSM_WaitFor (s, reqStartup, 22+PHONE_GetBitmapSize(Type,0,0), 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ case GSM_DealerNote_Text:
+ reqNote[4] = 0x10;
+ CopyUnicodeString(reqNote + 5, Bitmap->Text);
+ i = 6 + UnicodeLength(Bitmap->Text) * 2;
+ reqNote[i++] = 0;
+ reqNote[i] = 0;
+ return GSM_WaitFor (s, reqNote, i, 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ case GSM_WelcomeNote_Text:
+ CopyUnicodeString(reqNote + 5, Bitmap->Text);
+ i = 6 + UnicodeLength(Bitmap->Text) * 2;
+ reqNote[i++] = 0;
+ reqNote[i] = 0;
+ return GSM_WaitFor (s, reqNote, i, 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ case GSM_OperatorLogo:
+ /* We want to set operator logo, not clear */
+ if (strcmp(Bitmap->NetworkCode,"000 00")) {
+ memset(reqOp + 19, 0, 281);
+ NOKIA_EncodeNetworkCode(reqOp+12, Bitmap->NetworkCode);
+ Type = GSM_Nokia6510OperatorLogo;
+ reqOp[9] = 0x02; /* Logo enabled */
+ reqOp[18] = 0x1a; /* FIXME */
+ reqOp[19] = PHONE_GetBitmapSize(Type,0,0) + 8 + 29 + 2;
+ PHONE_GetBitmapWidthHeight(Type, &Width, &Height);
+ reqOp[20] = Width;
+ reqOp[21] = Height;
+ reqOp[22] = 0x00;
+ reqOp[23] = PHONE_GetBitmapSize(Type,0,0) + 29;
+ reqOp[24] = 0x00;
+ reqOp[25] = PHONE_GetBitmapSize(Type,0,0) + 29;
+ PHONE_EncodeBitmap(Type, reqOp + 26, Bitmap);
+ smprintf(s, "Setting operator logo\n");
+ return GSM_WaitFor (s, reqOp, reqOp[19]+reqOp[11]+10, 0x0A, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ } else {
+ error=N6510_GetNetworkInfo(s,&NetInfo);
+ if (error != ERR_NONE) return error;
+ NOKIA_EncodeNetworkCode(reqOp+12, NetInfo.NetworkCode);
+ smprintf(s, "Clearing operator logo\n");
+ return GSM_WaitFor (s, reqOp, 18, 0x0A, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ }
+ case GSM_ColourOperatorLogo_ID:
+ /* We want to set operator logo, not clear */
+ if (strcmp(Bitmap->NetworkCode,"000 00")) {
+ EncodeBCD(reqColourOp+23, Bitmap->NetworkCode, 6, FALSE);
+ reqColourOp[21] = Bitmap->ID;
+ }
+ smprintf(s, "Setting colour operator logo\n");
+ return GSM_WaitFor (s, reqColourOp, 26, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ case GSM_ColourStartupLogo_ID:
+ switch (Bitmap->Location) {
+ case 0: reqColourStartup[6] = 0x00;
+ reqColourStartup[8] = 0x00;
+ smprintf(s, "Setting colour startup logo\n");
+ return GSM_WaitFor (s, reqColourStartup, 9, 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ case 1: reqColourStartup[8] = Bitmap->ID;
+ smprintf(s, "Setting colour startup logo\n");
+ return GSM_WaitFor (s, reqColourStartup, 9, 0x7A, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ default:return ERR_NOTSUPPORTED;
+ }
+ case GSM_CallerGroupLogo:
+ return N6510_SetCallerLogo(s,Bitmap);
+ case GSM_PictureImage:
+ error = N6510_GetPictureImage(s, Bitmap, &sms.Location);
+ if (error == ERR_NONE) {
+ sms.Folder = 0;
+ N6510_GetSMSLocation(s, &sms, &folderid, &location);
+ switch (folderid) {
+ case 0x01: reqPicture[5] = 0x02; break; /* INBOX SIM */
+ case 0x02: reqPicture[5] = 0x03; break; /* OUTBOX SIM */
+ default : reqPicture[5] = folderid - 1; reqPicture[4] = 0x02; break; /* ME folders */
+ }
+ reqPicture[6]=location / 256;
+ reqPicture[7]=location;
+ }
+ Type = GSM_NokiaPictureImage;
+ count = 78;
+ PHONE_EncodeBitmap(Type, reqPicture + count, Bitmap);
+ count += PHONE_GetBitmapSize(Type,0,0);
+ smprintf(s, "Setting Picture Image\n");
+ return GSM_WaitFor (s, reqPicture, count, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_SetBitmap);
+ default:
+ break;
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6510_ReplyGetRingtoneID(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+
+ smprintf(s, "Ringtone ID received\n");
+ Priv->RingtoneID = msg->Buffer[15];
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_ReplySetBinRingtone(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Binary ringtone set\n");
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_SetRingtone(GSM_StateMachine *s, GSM_Ringtone *Ringtone, int *maxlength)
+{
+ GSM_Error error;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_NetworkInfo NetInfo;
+ size_t size=200, current;
+ unsigned char GetIDReq[] = {
+ N7110_FRAME_HEADER, 0x01, 0x00, 0x00,
+ 0x00, 0xFF, 0x06, 0xE1, 0x00,
+ 0xFF, 0x06, 0xE1, 0x01, 0x42};
+ unsigned char SetPreviewReq[1000] = {
+ 0xAE, /* Ringtone ID */
+ 0x01, 0x00, 0x0D, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00}; /*Length*/
+ unsigned char AddBinaryReq[33000] = {
+ N7110_FRAME_HEADER, 0x0E, 0x7F, 0xFF, 0xFE};
+
+ if (Ringtone->Format == RING_NOTETONE && Ringtone->Location==255)
+ {
+ smprintf(s, "Getting ringtone ID\n");
+ error=GSM_WaitFor (s, GetIDReq, 14, 0xDB, s->Phone.Data.Priv.N6510.Timeout, ID_SetRingtone);
+ if (error != ERR_NONE) return error;
+ *maxlength=GSM_EncodeNokiaRTTLRingtone(Ringtone, SetPreviewReq+11, &size);
+ SetPreviewReq[0] = Priv->RingtoneID;
+ SetPreviewReq[10] = size;
+ smprintf(s, "Setting ringtone\n");
+ error = s->Protocol.Functions->WriteMessage(s, SetPreviewReq, size+11, 0x00);
+ if (error!=ERR_NONE) return error;
+ sleep(1);
+ /* We have to make something (not important, what) now */
+ /* no answer from phone*/
+ return s->Phone.Functions->GetNetworkInfo(s,&NetInfo);
+ }
+ if (Ringtone->Format == RING_NOKIABINARY) {
+ AddBinaryReq[7] = UnicodeLength(Ringtone->Name);
+ CopyUnicodeString(AddBinaryReq+8,Ringtone->Name);
+ current = 8 + UnicodeLength(Ringtone->Name)*2;
+ AddBinaryReq[current++] = Ringtone->NokiaBinary.Length/256 + 1;
+ AddBinaryReq[current++] = Ringtone->NokiaBinary.Length%256 + 1;
+ AddBinaryReq[current++] = 0x00;
+ memcpy(AddBinaryReq+current,Ringtone->NokiaBinary.Frame,Ringtone->NokiaBinary.Length);
+ current += Ringtone->NokiaBinary.Length;
+ smprintf(s, "Adding binary ringtone\n");
+ return GSM_WaitFor (s, AddBinaryReq, current, 0x1F, s->Phone.Data.Priv.N6510.Timeout, ID_SetRingtone);
+ }
+ if (Ringtone->Format == RING_MIDI) {
+ AddBinaryReq[7] = UnicodeLength(Ringtone->Name);
+ CopyUnicodeString(AddBinaryReq+8,Ringtone->Name);
+ current = 8 + UnicodeLength(Ringtone->Name)*2;
+ AddBinaryReq[current++] = Ringtone->NokiaBinary.Length/256;
+ AddBinaryReq[current++] = Ringtone->NokiaBinary.Length%256;
+ memcpy(AddBinaryReq+current,Ringtone->NokiaBinary.Frame,Ringtone->NokiaBinary.Length);
+ current += Ringtone->NokiaBinary.Length;
+ AddBinaryReq[current++] = 0x00;
+ AddBinaryReq[current++] = 0x00;
+ smprintf(s, "Adding binary or MIDI ringtone\n");
+ return GSM_WaitFor (s, AddBinaryReq, current, 0x1F, s->Phone.Data.Priv.N6510.Timeout, ID_SetRingtone);
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6510_ReplyDeleteRingtones(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Ringtones deleted\n");
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_DeleteUserRingtones(GSM_StateMachine *s)
+{
+ unsigned char DelAllRingtoneReq[] = {N7110_FRAME_HEADER, 0x10, 0x7F, 0xFE};
+
+ smprintf(s, "Deleting all user ringtones\n");
+ return GSM_WaitFor (s, DelAllRingtoneReq, 6, 0x1F, s->Phone.Data.Priv.N6510.Timeout, ID_SetRingtone);
+}
+
+static GSM_Error N6510_ReplyPressKey(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ if (msg->Buffer[3] == 0x33) {
+ smprintf(s, "Key auto released\n");
+ } else if (msg->Buffer[3] == 0x12) {
+ smprintf(s, "Key pressed\n");
+ } else {
+ return ERR_UNKNOWN;
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_PressKey(GSM_StateMachine *s, GSM_KeyCode Key, gboolean Press)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x11, 0x00, 0x01, 0x00, 0x00,
+ 0x00, /* Event */
+ 0x01}; /* Number of presses */
+
+ if (Key != GSM_KEY_GREEN) {
+ smprintf(s, "Mapping for key code %d missing!\n", Key);
+ return ERR_NOTIMPLEMENTED;
+ }
+
+ req[7] = Key;
+ if (Press) {
+ req[8] = NOKIA_PRESSPHONEKEY;
+ s->Phone.Data.PressKey = TRUE;
+ smprintf(s, "Pressing key\n");
+ } else {
+ req[8] = NOKIA_RELEASEPHONEKEY;
+ s->Phone.Data.PressKey = FALSE;
+ smprintf(s, "Releasing key\n");
+ }
+ return GSM_WaitFor (s, req, 10, 0x0c, s->Phone.Data.Priv.N6510.Timeout, ID_PressKey);
+}
+
+static GSM_Error N6510_EnableConnectionFunctions(GSM_StateMachine *s, N6510_Connection_Settings Type)
+{
+ GSM_Error error;
+ unsigned char req2[] = {N6110_FRAME_HEADER, 0x00, 0x01};
+ unsigned char req3[] = {N6110_FRAME_HEADER, 0x00, 0x03};
+ unsigned char req4[] = {N6110_FRAME_HEADER, 0x00, 0x04};
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_6230iWAP)) return ERR_NOTSUPPORTED;
+
+ if (Type == N6510_MMS_SETTINGS && GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOMMS)) return ERR_NOTSUPPORTED;
+ if (Type == N6510_CHAT_SETTINGS && !GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_CHAT)) return ERR_NOTSUPPORTED;
+ if (Type == N6510_SYNCML_SETTINGS && !GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SYNCML)) return ERR_NOTSUPPORTED;
+
+ error=DCT3DCT4_DisableConnectionFunctions(s);
+ if (error!=ERR_NONE) return error;
+
+ switch (Type) {
+ case N6510_WAP_SETTINGS:
+ return DCT3DCT4_EnableWAPFunctions(s);
+ case N6510_MMS_SETTINGS:
+ smprintf(s, "Enabling MMS\n");
+ return GSM_WaitFor (s, req2, 5, 0x3f, s->Phone.Data.Priv.N6510.Timeout, ID_EnableConnectFunc);
+ case N6510_SYNCML_SETTINGS:
+ smprintf(s, "Enabling SyncML\n");
+ return GSM_WaitFor (s, req3, 5, 0x3f, 5, ID_EnableConnectFunc);
+ case N6510_CHAT_SETTINGS:
+ smprintf(s, "Enabling Chat\n");
+ return GSM_WaitFor (s, req4, 5, 0x3f, 5, ID_EnableConnectFunc);
+ default:
+ return ERR_UNKNOWN;
+ }
+}
+
+static GSM_Error N6510_ReplyGetConnectionSettings(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ int tmp,num=0,i;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ unsigned char buff[2000];
+
+ switch(msg->Buffer[3]) {
+ case 0x16:
+ smprintf(s, "Connection settings received OK\n");
+
+ Data->WAPSettings->Number = Priv->BearerNumber;
+
+ Data->WAPSettings->Proxy[0] = 0x00;
+ Data->WAPSettings->Proxy[1] = 0x00;
+ Data->WAPSettings->ProxyPort = 8080;
+
+ Data->WAPSettings->Proxy2[0] = 0x00;
+ Data->WAPSettings->Proxy2[1] = 0x00;
+ Data->WAPSettings->Proxy2Port = 8080;
+
+ tmp = 4;
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[0].Title,TRUE);
+ CopyUnicodeString(Data->WAPSettings->Settings[1].Title,Data->WAPSettings->Settings[0].Title);
+ smprintf(s, "Title: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[0].Title));
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[0].HomePage,TRUE);
+ CopyUnicodeString(Data->WAPSettings->Settings[1].HomePage,Data->WAPSettings->Settings[0].HomePage);
+ smprintf(s, "Homepage: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[0].HomePage));
+
+#ifdef DEBUG
+ smprintf(s, "Connection type: ");
+ switch (msg->Buffer[tmp]) {
+ case 0x00: smprintf(s, "temporary\n"); break;
+ case 0x01: smprintf(s, "continuous\n"); break;
+ default: smprintf(s, "unknown\n");
+ }
+ smprintf(s, "Connection security: ");
+ switch (msg->Buffer[tmp+1]) {
+ case 0x00: smprintf(s, "off\n"); break;
+ case 0x01: smprintf(s, "on\n"); break;
+ default: smprintf(s, "unknown\n");
+ }
+ smprintf(s, "Bearer: ");
+ switch (msg->Buffer[tmp+2]) {
+ case 0x01: smprintf(s, "GSM data\n"); break;
+ case 0x03: smprintf(s, "GPRS\n"); break;
+ default: smprintf(s, "unknown\n");
+ }
+ if (msg->Buffer[tmp+3] == 0x01) smprintf(s, "locked\n");
+#endif
+ Data->WAPSettings->Settings[0].IsContinuous = FALSE;
+ if (msg->Buffer[tmp] == 0x01) Data->WAPSettings->Settings[0].IsContinuous = TRUE;
+ Data->WAPSettings->Settings[1].IsContinuous = Data->WAPSettings->Settings[0].IsContinuous;
+
+ Data->WAPSettings->Settings[0].IsSecurity = FALSE;
+ if (msg->Buffer[tmp+1] == 0x01) Data->WAPSettings->Settings[0].IsSecurity = TRUE;
+ Data->WAPSettings->Settings[1].IsSecurity = Data->WAPSettings->Settings[0].IsSecurity;
+
+ Data->WAPSettings->ActiveBearer = WAPSETTINGS_BEARER_DATA;
+ if (msg->Buffer[tmp+2] == 0x03) Data->WAPSettings->ActiveBearer = WAPSETTINGS_BEARER_GPRS;
+
+ Data->WAPSettings->ReadOnly = FALSE;
+ if (msg->Buffer[tmp+3] == 0x01) Data->WAPSettings->ReadOnly = TRUE;
+
+ tmp+=3;
+
+ if (Priv->BearerNumber == 2) {
+ /* Here starts settings for data bearer */
+ Data->WAPSettings->Settings[0].Bearer = WAPSETTINGS_BEARER_DATA;
+ while ((msg->Buffer[tmp] != 0x01) || (msg->Buffer[tmp + 1] != 0x00)) tmp++;
+ tmp += 4;
+
+#ifdef DEBUG
+ smprintf(s, "Authentication type: ");
+ switch (msg->Buffer[tmp]) {
+ case 0x00: smprintf(s, "normal\n"); break;
+ case 0x01: smprintf(s, "secure\n"); break;
+ default: smprintf(s, "unknown\n"); break;
+ }
+ smprintf(s, "Data call type: ");
+ switch (msg->Buffer[tmp+1]) {
+ case 0x00: smprintf(s, "analogue\n"); break;
+ case 0x01: smprintf(s, "ISDN\n"); break;
+ default: smprintf(s, "unknown\n"); break;
+ }
+ smprintf(s, "Data call speed: ");
+ switch (msg->Buffer[tmp+2]) {
+ case 0x00: smprintf(s, "automatic\n"); break;
+ case 0x01: smprintf(s, "9600\n"); break;
+ case 0x02: smprintf(s, "14400\n"); break;
+ default: smprintf(s, "unknown\n"); break;
+ }
+ smprintf(s, "Login Type: ");
+ switch (msg->Buffer[tmp+4]) {
+ case 0x00: smprintf(s, "manual\n"); break;
+ case 0x01: smprintf(s, "automatic\n"); break;
+ default: smprintf(s, "unknown\n"); break;
+ }
+#endif
+ Data->WAPSettings->Settings[0].IsNormalAuthentication=TRUE;
+ if (msg->Buffer[tmp]==0x01) Data->WAPSettings->Settings[0].IsNormalAuthentication=FALSE;
+
+ Data->WAPSettings->Settings[0].IsISDNCall=FALSE;
+ if (msg->Buffer[tmp+1]==0x01) Data->WAPSettings->Settings[0].IsISDNCall=TRUE;
+
+ switch (msg->Buffer[tmp+2]) {
+ case 0x00: Data->WAPSettings->Settings[0].Speed=WAPSETTINGS_SPEED_AUTO; break;
+ case 0x01: Data->WAPSettings->Settings[0].Speed=WAPSETTINGS_SPEED_9600; break;
+ case 0x02: Data->WAPSettings->Settings[0].Speed=WAPSETTINGS_SPEED_14400; break;
+ default:
+ smprintf(s, "Unknown speed settings: 0x%0x\n", msg->Buffer[tmp+2]);
+ Data->WAPSettings->Settings[0].Speed=WAPSETTINGS_SPEED_AUTO;
+ break;
+ }
+
+ Data->WAPSettings->Settings[0].ManualLogin=FALSE;
+ if (msg->Buffer[tmp+4]==0x00) Data->WAPSettings->Settings[0].ManualLogin = TRUE;
+
+ tmp+=5;
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[0].IPAddress,FALSE);
+ smprintf(s, "IP address: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[0].IPAddress));
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[0].DialUp,TRUE);
+ smprintf(s, "Dial-up number: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[0].DialUp));
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[0].User,TRUE);
+ smprintf(s, "User name: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[0].User));
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[0].Password,TRUE);
+ smprintf(s, "Password: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[0].Password));
+
+ num = 1;
+ } else {
+ num = 0;
+ }
+
+ /* Here starts settings for gprs bearer */
+ Data->WAPSettings->Settings[num].Bearer = WAPSETTINGS_BEARER_GPRS;
+ while (msg->Buffer[tmp] != 0x03) tmp++;
+ tmp += 4;
+
+#ifdef DEBUG
+ smprintf(s, "Authentication type: ");
+ switch (msg->Buffer[tmp]) {
+ case 0x00: smprintf(s, "normal\n"); break;
+ case 0x01: smprintf(s, "secure\n"); break;
+ default: smprintf(s, "unknown\n"); break;
+ }
+ smprintf(s, "GPRS connection: ");
+ switch (msg->Buffer[tmp+1]) {
+ case 0x00: smprintf(s, "ALWAYS online\n"); break;
+ case 0x01: smprintf(s, "when needed\n"); break;
+ default: smprintf(s, "unknown\n"); break;
+ }
+ smprintf(s, "Login Type: ");
+ switch (msg->Buffer[tmp+2]) {
+ case 0x00: smprintf(s, "manual\n"); break;
+ case 0x01: smprintf(s, "automatic\n"); break;
+ default: smprintf(s, "unknown\n"); break;
+ }
+#endif
+ Data->WAPSettings->Settings[num].IsNormalAuthentication=TRUE;
+ if (msg->Buffer[tmp]==0x01) Data->WAPSettings->Settings[num].IsNormalAuthentication=FALSE;
+
+ Data->WAPSettings->Settings[num].IsISDNCall=FALSE;
+ Data->WAPSettings->Settings[num].Speed = WAPSETTINGS_SPEED_AUTO;
+
+ Data->WAPSettings->Settings[num].IsContinuous = TRUE;
+ if (msg->Buffer[tmp+1] == 0x01) Data->WAPSettings->Settings[num].IsContinuous = FALSE;
+
+ Data->WAPSettings->Settings[num].ManualLogin=FALSE;
+ if (msg->Buffer[tmp+2]==0x00) Data->WAPSettings->Settings[num].ManualLogin = TRUE;
+
+ tmp+=3;
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[num].DialUp,FALSE);
+ smprintf(s, "Access point: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[num].DialUp));
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[num].IPAddress,TRUE);
+ smprintf(s, "IP address: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[num].IPAddress));
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[num].User,TRUE);
+ smprintf(s, "User name: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[num].User));
+
+ NOKIA_GetUnicodeString(s, &tmp, msg->Buffer, Data->WAPSettings->Settings[num].Password,TRUE);
+ smprintf(s, "Password: \"%s\"\n",DecodeUnicodeString(Data->WAPSettings->Settings[num].Password));
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_WAPMMSPROXY)) {
+ if (msg->Buffer[tmp] == 0x00 && msg->Buffer[tmp+1] == 0x00) tmp = tmp+2;
+
+ memcpy(buff,msg->Buffer+tmp+10,msg->Buffer[tmp+4]);
+ buff[msg->Buffer[tmp+4]] = 0x00;
+ smprintf(s, "Proxy 1: \"%s\", port %i\n",buff,msg->Buffer[tmp+6]*256+msg->Buffer[tmp+7]);
+ EncodeUnicode(Data->WAPSettings->Proxy,buff,strlen(buff));
+ Data->WAPSettings->ProxyPort = msg->Buffer[tmp+6]*256+msg->Buffer[tmp+7];
+
+ memcpy(buff,msg->Buffer+tmp+10+msg->Buffer[tmp+4],msg->Buffer[tmp+5]);
+ buff[msg->Buffer[tmp+5]] = 0x00;
+ smprintf(s, "Proxy 2: \"%s\", port %i\n",buff,msg->Buffer[tmp+8]*256+msg->Buffer[tmp+9]);
+ EncodeUnicode(Data->WAPSettings->Proxy2,buff,strlen(buff));
+ Data->WAPSettings->Proxy2Port = msg->Buffer[tmp+8]*256+msg->Buffer[tmp+9];
+
+ tmp = tmp + msg->Buffer[tmp+3] + 19;
+
+ for (i=0;i<4;i++) {
+#ifdef DEBUG
+ smprintf(s, "Proxy data %i\n",i+1);
+ if (msg->Buffer[tmp+2]!=0) memcpy(buff,msg->Buffer+tmp+9,msg->Buffer[tmp+2]*2);
+ buff[msg->Buffer[tmp+2]*2] =0;
+ buff[msg->Buffer[tmp+2]*2+1]=0;
+ smprintf(s, "IP: \"%s\"",DecodeUnicodeString(buff));
+ smprintf(s, ", port %i\n",msg->Buffer[tmp+3]*256+msg->Buffer[tmp+4]);
+#endif
+ tmp = tmp + msg->Buffer[tmp];
+ }
+
+#ifdef DEBUG
+ smprintf(s, "%02x %02x\n",msg->Buffer[tmp],msg->Buffer[tmp+1]);
+ smprintf(s, "Port %i\n",msg->Buffer[tmp+3]*256+msg->Buffer[tmp+4]);
+ tmp = tmp + msg->Buffer[tmp];
+#endif
+ }
+
+ return ERR_NONE;
+ case 0xf0:
+ /*
+ * Don't know exactly what 0x0f means, but the message is too short
+ * to contain information:
+ *
+ * 01 |58X|00 |F0 |01 |15 |00 |00 |00 |00
+ */
+ smprintf(s, "Connection settings receiving error, assuming empty\n");
+ return ERR_EMPTY;
+ case 0x11:
+ case 0x17:
+ smprintf(s, "Connection settings receiving error\n");
+ switch (msg->Buffer[4]) {
+ case 0x01:
+ smprintf(s, "Security error. Inside phone settings menu\n");
+ return ERR_INSIDEPHONEMENU;
+ case 0x02:
+ case 0x03: /* Guess */
+ smprintf(s, "Invalid or empty\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetConnectionSettings(GSM_StateMachine *s, GSM_MultiWAPSettings *settings, N6510_Connection_Settings Type)
+{
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ GSM_Error error;
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x15,
+ 0x00}; /* Location */
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) return ERR_NOTSUPPORTED;
+ if (!strcmp(s->Phone.Data.ModelInfo->model,"6020")) return ERR_NOTSUPPORTED;
+
+ error = N6510_EnableConnectionFunctions(s, Type);
+ if (error!=ERR_NONE) return error;
+
+ req[4] = settings->Location-1;
+ s->Phone.Data.WAPSettings = settings;
+
+ switch (Type) {
+ case N6510_MMS_SETTINGS:
+ smprintf(s, "Getting MMS settings\n");
+ Priv->BearerNumber = 1;
+ break;
+ case N6510_WAP_SETTINGS:
+ smprintf(s, "Getting WAP settings\n");
+ Priv->BearerNumber = 2;
+ break;
+ case N6510_SYNCML_SETTINGS:
+ smprintf(s, "Getting SyncML settings\n");
+ Priv->BearerNumber = 2;
+ break;
+ case N6510_CHAT_SETTINGS:
+ smprintf(s, "Getting Chat settings\n");
+ Priv->BearerNumber = 1;
+ break;
+ }
+
+ error=GSM_WaitFor (s, req, 5, 0x3f, s->Phone.Data.Priv.N6510.Timeout, ID_GetConnectSet);
+ if (error != ERR_NONE) {
+ if (error == ERR_INVALIDLOCATION || error == ERR_INSIDEPHONEMENU) {
+ DCT3DCT4_DisableConnectionFunctions(s);
+ }
+ return error;
+ }
+
+ error=DCT3DCT4_GetActiveConnectSet(s);
+ if (error != ERR_NONE) return error;
+
+ return DCT3DCT4_DisableConnectionFunctions(s);
+}
+
+static GSM_Error N6510_GetWAPSettings(GSM_StateMachine *s, GSM_MultiWAPSettings *settings)
+{
+ return N6510_GetConnectionSettings(s, settings, N6510_WAP_SETTINGS);
+}
+
+static GSM_Error N6510_GetMMSSettings(GSM_StateMachine *s, GSM_MultiWAPSettings *settings)
+{
+ return N6510_GetConnectionSettings(s, settings, N6510_MMS_SETTINGS);
+}
+
+static GSM_Error N6510_ReplyGetSyncMLSettings(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_SyncMLSettings *Sett = s->Phone.Data.SyncMLSettings;
+
+ smprintf(s, "SyncML settings received OK\n");
+ CopyUnicodeString(Sett->User,msg->Buffer+18);
+ CopyUnicodeString(Sett->Password,msg->Buffer+86);
+ CopyUnicodeString(Sett->PhonebookDataBase,msg->Buffer+130);
+ CopyUnicodeString(Sett->CalendarDataBase,msg->Buffer+234);
+ CopyUnicodeString(Sett->Server,msg->Buffer+338);
+
+ Sett->SyncPhonebook = FALSE;
+ Sett->SyncCalendar = FALSE;
+ if ((msg->Buffer[598] & 0x02)==0x02) Sett->SyncCalendar = TRUE;
+ if ((msg->Buffer[598] & 0x01)==0x01) Sett->SyncPhonebook = TRUE;
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_ReplyGetSyncMLName(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_SyncMLSettings *Sett = s->Phone.Data.SyncMLSettings;
+
+ smprintf(s, "SyncML names received OK\n");
+
+ CopyUnicodeString(Sett->Name,msg->Buffer+18);
+
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetSyncMLSettings(GSM_StateMachine *s, GSM_SyncMLSettings *settings)
+{
+ GSM_Error error;
+/* unsigned char NameReq[] = {N6110_FRAME_HEADER, 0x05, */
+/* 0x00, 0x00, 0x00, 0x31, 0x00, */
+/* 0x06, 0x00, 0x00, 0x00, 0xDE, 0x00, 0x00}; */
+/* unsigned char GetActive[] = {N6110_FRAME_HEADER, 0x05, */
+/* 0x00, 0x00, 0x00, 0x31, 0x00, */
+/* 0x05, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00}; */
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x05,
+ 0x00, 0x00, 0x00, 0x31, 0x00,
+ 0x01, /* location */
+ 0x00, 0x00, 0x02, 0x46, 0x00, 0x00};
+
+ settings->Connection.Location = settings->Location;
+ error = N6510_GetConnectionSettings(s, &settings->Connection, N6510_SYNCML_SETTINGS);
+ if (error != ERR_NONE) return error;
+
+ settings->Active = settings->Connection.Active;
+
+ settings->Name[0] = 0;
+ settings->Name[1] = 0;
+ s->Phone.Data.SyncMLSettings = settings;
+
+/* smprintf(s, "Getting SyncML settings name\n"); */
+/* error = GSM_WaitFor (s, NameReq, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_GetSyncMLName); */
+/* if (error != ERR_NONE) return error; */
+
+ req[9] = settings->Location - 1;
+ smprintf(s, "Getting additional SyncML settings\n");
+ return GSM_WaitFor (s, req, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_GetSyncMLSettings);
+}
+
+static GSM_Error N6510_ReplyGetChatSettings(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_ChatSettings *Sett = s->Phone.Data.ChatSettings;
+ int i;
+
+ Sett->Name[0] = 0;
+ Sett->Name[1] = 0;
+ Sett->HomePage[0] = 0;
+ Sett->HomePage[1] = 0;
+ Sett->User[0] = 0;
+ Sett->User[1] = 0;
+ Sett->Password[0] = 0;
+ Sett->Password[1] = 0;
+
+ switch(msg->Buffer[3]) {
+ case 0x3B:
+ smprintf(s, "Chat settings received OK\n");
+ memcpy(Sett->Name,msg->Buffer+20,msg->Buffer[12]*2);
+ Sett->Name[msg->Buffer[12]*2] = 0;
+ Sett->Name[msg->Buffer[12]*2+1] = 0;
+ memcpy(Sett->HomePage,msg->Buffer+20+msg->Buffer[12]*2,msg->Buffer[15]*2);
+ Sett->HomePage[msg->Buffer[15]*2] = 0;
+ Sett->HomePage[msg->Buffer[15]*2+1] = 0;
+ i = msg->Buffer[12]*2 + msg->Buffer[15]*2 + 29;
+ memcpy(Sett->User,msg->Buffer+i+3,msg->Buffer[i]*2);
+ Sett->User[msg->Buffer[i]*2] = 0;
+ Sett->User[msg->Buffer[i]*2+1] = 0;
+ memcpy(Sett->Password,msg->Buffer+i+3+msg->Buffer[i]*2,msg->Buffer[i+1]*2);
+ Sett->Password[msg->Buffer[i+1]*2] = 0;
+ Sett->Password[msg->Buffer[i+1]*2+1] = 0;
+ return ERR_NONE;
+ case 0x3C:
+ smprintf(s, "Empty chat settings received\n");
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetChatSettings(GSM_StateMachine *s, GSM_ChatSettings *settings)
+{
+ GSM_Error error;
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x3a,
+ 0x09, /* location */
+ 0x01, 0x0e};
+
+ settings->Connection.Location = settings->Location;
+ error = N6510_GetConnectionSettings(s, &settings->Connection, N6510_CHAT_SETTINGS);
+ if (error != ERR_NONE) return error;
+
+ settings->Active = settings->Connection.Active;
+
+ s->Phone.Data.ChatSettings = settings;
+ req[4] = settings->Location - 1;
+ smprintf(s, "Getting additional Chat settings\n");
+ return GSM_WaitFor (s, req, 7, 0x3f, s->Phone.Data.Priv.N6510.Timeout, ID_GetChatSettings);
+}
+
+static GSM_Error N6510_ReplySetConnectionSettings(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[3]) {
+ case 0x19:
+ smprintf(s, "Connection settings cleaned\n");
+ return ERR_NONE;
+ case 0x1a:
+ smprintf(s, "Connection settings setting status\n");
+ switch (msg->Buffer[4]) {
+ case 0x01:
+ smprintf(s, "Security error. Inside phone settings menu\n");
+ return ERR_INSIDEPHONEMENU;
+ case 0x03:
+ smprintf(s, "Invalid location\n");
+ return ERR_INVALIDLOCATION;
+ case 0x05:
+ smprintf(s, "Written OK\n");
+ return ERR_NONE;
+ default:
+ smprintf(s, "ERROR: unknown %i\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ case 0x28:
+ case 0x2B:
+ smprintf(s, "Set OK\n");
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_SetConnectionSettings(GSM_StateMachine *s, GSM_MultiWAPSettings *settings, N6510_Connection_Settings Type)
+{
+ GSM_Error error;
+ int i, pad = 0, length, pos = 5, loc1=-1,loc2=-1,port;
+ unsigned char *Proxy;
+ unsigned char req[2000] = {N6110_FRAME_HEADER, 0x18,
+ 0x00}; /* Location */
+ unsigned char Lock[5] = {N6110_FRAME_HEADER, 0x27,
+ 0x00}; /* Location */
+ unsigned char UnLock[5] = {N6110_FRAME_HEADER, 0x2A,
+ 0x00}; /* Location */
+
+ error = N6510_EnableConnectionFunctions(s, Type);
+ if (error!=ERR_NONE) return error;
+
+ memset(req + pos, 0, 1000 - pos);
+
+ req[4] = settings->Location-1;
+
+ for (i=0;i<settings->Number;i++) {
+ if (settings->Settings[i].Bearer == WAPSETTINGS_BEARER_DATA) loc1=i;
+ if (settings->Settings[i].Bearer == WAPSETTINGS_BEARER_GPRS) loc2=i;
+ }
+
+ if (loc1 != -1) {
+ /* Name */
+ length = UnicodeLength(settings->Settings[loc1].Title);
+ if (!(length % 2)) pad = 1;
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc1].Title, FALSE);
+
+ /* Home */
+ length = UnicodeLength(settings->Settings[loc1].HomePage);
+ if (((length + pad) % 2)) pad = 2; else pad = 0;
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc1].HomePage, TRUE);
+
+ if (settings->Settings[loc1].IsContinuous) {
+ req[pos] = 0x01;
+ }
+ pos++;
+ if (settings->Settings[loc1].IsSecurity) {
+ req[pos] = 0x01;
+ }
+ pos++;
+ } else if (loc2 != -1) {
+ /* Name */
+ length = UnicodeLength(settings->Settings[loc2].Title);
+ if (!(length % 2)) pad = 1;
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc2].Title, FALSE);
+
+ /* Home */
+ length = UnicodeLength(settings->Settings[loc2].HomePage);
+ if (((length + pad) % 2)) pad = 2; else pad = 0;
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc2].HomePage, TRUE);
+
+ if (settings->Settings[loc2].IsContinuous) {
+ req[pos] = 0x01;
+ }
+ pos++;
+ if (settings->Settings[loc2].IsSecurity) {
+ req[pos] = 0x01;
+ }
+ pos++;
+ } else {
+ /* Name */
+ length = 0;
+ if (!(length % 2)) pad = 1;
+ pos ++;
+
+ /* Home */
+ length = 0;
+ if (((length + pad) % 2)) pad = 2; else pad = 0;
+ pos += 2;
+
+ pos += 2;
+ }
+
+ if (Type == N6510_MMS_SETTINGS || Type == N6510_CHAT_SETTINGS) {
+ req[pos++] = 0x03; /* active bearer: GPRS */
+ } else {
+ if (settings->ActiveBearer == WAPSETTINGS_BEARER_GPRS && loc2 != -1) {
+ req[pos++] = 0x03; /* active bearer: GPRS */
+ } else {
+ req[pos++] = 0x01; /* active bearer: data set */
+ }
+ }
+
+ /* Number of sent bearers */
+ if (Type == N6510_MMS_SETTINGS || Type == N6510_CHAT_SETTINGS) {
+ req[pos] = 0x01;
+ } else {
+ req[pos] = 0x02;
+ }
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_WAPMMSPROXY)) req[pos] += 2;
+ pos++;
+ pos += pad;
+
+ if (Type != N6510_MMS_SETTINGS && Type != N6510_CHAT_SETTINGS) {
+ /* GSM data block */
+ memcpy(req + pos, "\x01\x00", 2); pos += 2;
+
+ if (loc1 != -1) {
+ length = UnicodeLength(settings->Settings[loc1].IPAddress)*2+1;
+ length += UnicodeLength(settings->Settings[loc1].DialUp) *2+2;
+ length += UnicodeLength(settings->Settings[loc1].User) *2+2;
+ length += UnicodeLength(settings->Settings[loc1].Password) *2+2;
+ } else {
+ length = 1 + 2 + 2 + 2;
+ }
+ length += 11;
+ req[pos++] = length / 256;
+ req[pos++] = length % 256;
+
+ if (loc1 != -1) {
+ if (!settings->Settings[loc1].IsNormalAuthentication) {
+ req[pos]=0x01;
+ }
+ pos++;
+ if (settings->Settings[loc1].IsISDNCall) {
+ req[pos]=0x01;
+ }
+ pos++;
+ switch (settings->Settings[loc1].Speed) {
+ case WAPSETTINGS_SPEED_AUTO : break;
+ case WAPSETTINGS_SPEED_9600 : req[pos]=0x01; break;
+ case WAPSETTINGS_SPEED_14400 : req[pos]=0x02; break;
+ }
+ pos++;
+ req[pos++]=0x01;
+ if (!settings->Settings[loc1].ManualLogin) {
+ req[pos] = 0x01;
+ }pos++;
+
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc1].IPAddress, FALSE);
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc1].DialUp, TRUE);
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc1].User, TRUE);
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc1].Password, TRUE);
+ } else {
+ pos += 3;
+ req[pos++]=0x01;
+ pos += 8;
+ }
+
+ /* Padding */
+ pos+=2;
+ }
+
+ /* GPRS block */
+ memcpy(req + pos, "\x03\x00", 2); pos += 2;
+
+ if (loc2 != -1) {
+ length = UnicodeLength(settings->Settings[loc2].DialUp) *2+1;
+ length += UnicodeLength(settings->Settings[loc2].IPAddress)*2+2;
+ length += UnicodeLength(settings->Settings[loc2].User) *2+2;
+ length += UnicodeLength(settings->Settings[loc2].Password) *2+2;
+ } else {
+ length = 7;
+ }
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_WAPMMSPROXY)) length+=2;
+ length += 7;
+ req[pos++] = length / 256;
+ req[pos++] = length % 256;
+
+ if (loc2 != -1) {
+ if (!settings->Settings[loc2].IsNormalAuthentication) {
+ req[pos] = 0x01;
+ }
+ pos++;
+ if (!settings->Settings[loc2].IsContinuous) {
+ req[pos] = 0x01;
+ }
+ pos++;
+ if (!settings->Settings[loc2].ManualLogin) {
+ req[pos] = 0x01;
+ }
+ pos++;
+
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc2].DialUp, FALSE);
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc2].IPAddress, TRUE);
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc2].User, TRUE);
+ pos += NOKIA_SetUnicodeString(s, req + pos, settings->Settings[loc2].Password, TRUE);
+ } else {
+ pos += 10;
+ }
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_WAPMMSPROXY)) {
+ req[pos++] = 0x00;
+ req[pos++] = 0x00;
+
+ /* Proxy block */
+ req[pos++] = 0x06;
+ req[pos++] = 0x01;
+ if (UnicodeLength(settings->Proxy)!=0 ||
+ UnicodeLength(settings->Proxy2)!=0) {
+ req[pos++] = (UnicodeLength(settings->Proxy)+UnicodeLength(settings->Proxy2)+13)/256;
+ req[pos++] = (UnicodeLength(settings->Proxy)+UnicodeLength(settings->Proxy2)+13)%256;
+ } else {
+ req[pos++] = (UnicodeLength(settings->Proxy)+UnicodeLength(settings->Proxy2)+12)/256;
+ req[pos++] = (UnicodeLength(settings->Proxy)+UnicodeLength(settings->Proxy2)+12)%256;
+ }
+ req[pos++] = UnicodeLength(settings->Proxy);
+ req[pos++] = UnicodeLength(settings->Proxy2);
+ req[pos++] = settings->ProxyPort/256;
+ req[pos++] = settings->ProxyPort%256;
+ req[pos++] = settings->Proxy2Port/256;
+ req[pos++] = settings->Proxy2Port%256;
+ if (UnicodeLength(settings->Proxy)!=0) {
+ sprintf(req+pos,"%s",DecodeUnicodeString(settings->Proxy));
+ pos+=UnicodeLength(settings->Proxy);
+ }
+ if (UnicodeLength(settings->Proxy2)!=0) {
+ sprintf(req+pos,"%s",DecodeUnicodeString(settings->Proxy2));
+ pos+=UnicodeLength(settings->Proxy2);
+ }
+ if (UnicodeLength(settings->Proxy)!=0 ||
+ UnicodeLength(settings->Proxy2)!=0) {
+ req[pos++] = 0x00;
+ }
+ req[pos++] = 0x00; req[pos++] = 0x00;
+ req[pos++] = 0x07; /* unknown */
+ req[pos++] = 0x00; req[pos++] = 0x00;
+ req[pos++] = 0x80; /* unknown */
+ req[pos++] = 0x01; /* unknown */
+ req[pos++] = 0x05; /* unknown */
+ req[pos++] = 0x00; req[pos++] = 0x00;
+
+ /* Proxy data blocks */
+ for (i=0;i<4;i++) {
+ port = 8080;
+ Proxy = NULL;
+ if (i==0) {
+ port = settings->ProxyPort;
+ Proxy = settings->Proxy;
+ } else if (i==1) {
+ port = settings->Proxy2Port;
+ Proxy = settings->Proxy2;
+ }
+ req[pos++] = 0x08; req[pos++] = 0x00;
+ if (Proxy != NULL && UnicodeLength(Proxy)!=0) {
+ if (UnicodeLength(Proxy)%2 != 0) {
+ req[pos++] = (12 + (UnicodeLength(Proxy)+1)*2)/256;
+ req[pos++] = (12 + (UnicodeLength(Proxy)+1)*2)%256;
+ } else {
+ req[pos++] = (12 + UnicodeLength(Proxy)*2)/256;
+ req[pos++] = (12 + UnicodeLength(Proxy)*2)%256;
+ }
+ } else {
+ req[pos++] = 12/256;
+ req[pos++] = 12%256;
+ }
+ req[pos++] = i+1;
+ if (Proxy != NULL) {
+ req[pos++] = UnicodeLength(Proxy);
+ } else {
+ req[pos++] = 0;
+ }
+ req[pos++] = port/256;
+ req[pos++] = port%256;
+ req[pos++] = 0x00;
+
+ req[pos++] = 0x00;
+ req[pos++] = 0x01;
+
+ req[pos++] = 0x00;
+ if (Proxy != NULL && UnicodeLength(Proxy)!=0) {
+ CopyUnicodeString(req+pos,Proxy);
+ pos+=UnicodeLength(Proxy)*2;
+ if (UnicodeLength(Proxy)%2 != 0) {
+ req[pos++] = 0x00;
+ req[pos++] = 0x00;
+ }
+ }
+ }
+
+ req[pos++] = 0x09; req[pos++] = 0x00; req[pos++] = 0x00;
+ req[pos++] = 0x0C; req[pos++] = 0x02; req[pos++] = 0x00;
+ req[pos++] = 0x00; req[pos++] = 0x02; req[pos++] = 0x00;
+ req[pos++] = 0x00; req[pos++] = 0x00; req[pos++] = 0x00;
+ } else {
+ /* end of blocks ? */
+ memcpy(req + pos, "\x80\x00\x00\x0c", 4); pos += 4;
+ }
+
+ UnLock[4] = settings->Location-1;
+ smprintf(s, "Making Connection settings read-write\n");
+ error = GSM_WaitFor (s, UnLock, 5, 0x3f, s->Phone.Data.Priv.N6510.Timeout, ID_SetConnectSet);
+ if (error != ERR_NONE) return error;
+
+ switch (Type) {
+ case N6510_MMS_SETTINGS:
+ smprintf(s, "Setting MMS settings\n");
+ break;
+ case N6510_CHAT_SETTINGS:
+ smprintf(s, "Setting Chat settings\n");
+ break;
+ case N6510_WAP_SETTINGS:
+ smprintf(s, "Setting WAP settings\n");
+ break;
+ case N6510_SYNCML_SETTINGS:
+ smprintf(s, "Setting SyncML settings\n");
+ break;
+ }
+ error = GSM_WaitFor (s, req, pos, 0x3f, s->Phone.Data.Priv.N6510.Timeout, ID_SetConnectSet);
+ if (error != ERR_NONE) {
+ if (error == ERR_INSIDEPHONEMENU || error == ERR_INVALIDLOCATION) {
+ DCT3DCT4_DisableConnectionFunctions(s);
+ }
+ return error;
+ }
+
+ if (settings->ReadOnly) {
+ Lock[4] = settings->Location-1;
+ smprintf(s, "Making Connection settings readonly\n");
+ error = GSM_WaitFor (s, Lock, 5, 0x3f, s->Phone.Data.Priv.N6510.Timeout, ID_SetConnectSet);
+ if (error != ERR_NONE) return error;
+ }
+
+ error = DCT3DCT4_SetActiveConnectSet(s, settings);
+ if (error != ERR_NONE) return error;
+
+ return DCT3DCT4_DisableConnectionFunctions(s);
+}
+
+static GSM_Error N6510_SetWAPSettings(GSM_StateMachine *s, GSM_MultiWAPSettings *settings)
+{
+ return N6510_SetConnectionSettings(s, settings, N6510_WAP_SETTINGS);
+}
+
+static GSM_Error N6510_SetMMSSettings(GSM_StateMachine *s, GSM_MultiWAPSettings *settings)
+{
+ return N6510_SetConnectionSettings(s, settings, N6510_MMS_SETTINGS);
+}
+
+static GSM_Error N6510_ReplyGetOriginalIMEI(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ if (msg->Buffer[7] == 0x00) {
+ smprintf(s, "No SIM card\n");
+ return ERR_NOSIM;
+ } else {
+ return NOKIA_ReplyGetPhoneString(msg, s);
+ }
+}
+
+static GSM_Error N6510_GetOriginalIMEI(GSM_StateMachine *s, char *value)
+{
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) return ERR_NOTSUPPORTED;
+
+ return NOKIA_GetPhoneString(s,"\x00\x07\x02\x01\x00\x01",6,0x42,value,ID_GetOriginalIMEI,14);
+}
+
+static GSM_Error N6510_ReplyGetSMSStatus(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg->Buffer[3]) {
+ case 0x09:
+ switch (msg->Buffer[4]) {
+ case 0x00:
+ smprintf(s, "Max. in phone memory : %i\n",msg->Buffer[10]*256+msg->Buffer[11]);
+ smprintf(s, "Used in phone memory : %i\n",msg->Buffer[12]*256+msg->Buffer[13]);
+ smprintf(s, "Unread in phone memory : %i\n",msg->Buffer[14]*256+msg->Buffer[15]);
+ smprintf(s, "Max. in SIM : %i\n",msg->Buffer[22]*256+msg->Buffer[23]);
+ smprintf(s, "Used in SIM : %i\n",msg->Buffer[24]*256+msg->Buffer[25]);
+ smprintf(s, "Unread in SIM : %i\n",msg->Buffer[26]*256+msg->Buffer[27]);
+ Data->SMSStatus->PhoneSize = msg->Buffer[10]*256+msg->Buffer[11];
+ Data->SMSStatus->PhoneUsed = msg->Buffer[12]*256+msg->Buffer[13];
+ Data->SMSStatus->PhoneUnRead = msg->Buffer[14]*256+msg->Buffer[15];
+ Data->SMSStatus->SIMSize = msg->Buffer[22]*256+msg->Buffer[23];
+ Data->SMSStatus->SIMUsed = msg->Buffer[24]*256+msg->Buffer[25];
+ Data->SMSStatus->SIMUnRead = msg->Buffer[26]*256+msg->Buffer[27];
+ return ERR_NONE;
+ case 0x0f:
+ smprintf(s, "No PIN\n");
+ return ERR_SECURITYERROR;
+ default:
+ smprintf(s, "ERROR: unknown SMS status %i\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ case 0x1a:
+ smprintf(s, "Wait a moment. Phone is during power on and busy now\n");
+ return ERR_SECURITYERROR;
+ case 0xf0:
+ /* 01 |00 |00 |F0ð|01 |12 |00 |00 |00 */
+ smprintf(s, "Handling of this reply is not known, please help!\n");
+ return ERR_NOTIMPLEMENTED;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetSMSStatus(GSM_StateMachine *s, GSM_SMSMemoryStatus *status)
+{
+ GSM_Error error;
+ GSM_Phone_N6510Data *Priv = &s->Phone.Data.Priv.N6510;
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x08, 0x00, 0x00};
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) return ERR_NOTSUPPORTED;
+
+ s->Phone.Data.SMSStatus=status;
+ smprintf(s, "Getting SMS status\n");
+ error = GSM_WaitFor (s, req, 6, 0x14, 20, ID_GetSMSStatus);
+ if (error != ERR_NONE) return error;
+
+ /* DCT4 family doesn't show in frame with SMS status info
+ * about Templates. We get separately info about this SMS folder.
+ */
+ error = N6510_GetSMSFolderStatus(s, 0x06);
+ if (error != ERR_NONE) return error;
+ status->TemplatesUsed = Priv->LastSMSFolder.Number;
+
+ return error;
+}
+
+static GSM_Error N6510_ReplyDeleteSMSMessage(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[3]) {
+ case 0x05:
+ smprintf(s, "SMS deleted OK\n");
+ return ERR_NONE;
+ case 0x06:
+ switch (msg->Buffer[4]) {
+ case 0x02:
+ smprintf(s, "Invalid location\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "Unknown error: %02x\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_DeleteSMSMessage(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ unsigned char folderid;
+ unsigned int location;
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x04,
+ 0x01, /* 0x01=SM, 0x02=ME */
+ 0x00, /* FolderID */
+ 0x00, 0x02, /* Location */
+ 0x0F, 0x55};
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SMS_FILES)) return ERR_NOTSUPPORTED;
+ }
+
+ N6510_GetSMSLocation(s, sms, &folderid, &location);
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ switch (folderid) {
+ case 0x01: req[5] = 0x01; break; /* SIM */
+ default : req[5] = folderid; req[4] = 0x02; break; /* ME folders */
+ }
+ } else {
+ switch (folderid) {
+ case 0x01: req[5] = 0x02; break; /* INBOX SIM */
+ case 0x02: req[5] = 0x03; break; /* OUTBOX SIM */
+ default : req[5] = folderid - 1; req[4] = 0x02; break; /* ME folders */
+ }
+ }
+ req[6]=location / 256;
+ req[7]=location % 256;
+
+ smprintf(s, "Deleting sms\n");
+ return GSM_WaitFor (s, req, 10, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_DeleteSMSMessage);
+}
+
+static GSM_Error N6510_ReplySendSMSMessage(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[8]) {
+ case 0x00:
+ smprintf(s, "SMS sent OK, TPMR for sent sms is %d\n",msg->Buffer[10]);
+ if (s->User.SendSMSStatus!=NULL) s->User.SendSMSStatus(s,0,msg->Buffer[10], s->User.SendSMSStatusUserData);
+ return ERR_NONE;
+ default:
+ smprintf(s, "SMS not sent OK, error code probably %i\n",msg->Buffer[8]);
+ if (s->User.SendSMSStatus!=NULL) s->User.SendSMSStatus(s,msg->Buffer[8],msg->Buffer[10], s->User.SendSMSStatusUserData);
+ return ERR_NONE;
+ }
+}
+
+static GSM_Error N6510_SendSMSMessage(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ int length = 11;
+ GSM_Error error;
+ GSM_SMSMessageLayout Layout;
+ unsigned char req [300] = {
+ N6110_FRAME_HEADER, 0x02, 0x00, 0x00, 0x00, 0x55, 0x55};
+
+ if (sms->PDU == SMS_Deliver) sms->PDU = SMS_Submit;
+ memset(req+9,0x00,sizeof(req) - 9);
+ error=N6510_EncodeSMSFrame(s, sms, req + 9, &Layout, &length);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Sending sms\n");
+ return s->Protocol.Functions->WriteMessage(s, req, length + 9, 0x02);
+}
+
+static GSM_Error N6510_ReplyGetSecurityStatus(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ if (msg->Buffer[3] == 0xf0) {
+ return ERR_NOTSUPPORTED;
+ }
+
+ smprintf(s, "Security Code status received: ");
+ switch (msg->Buffer[4]) {
+ case 0x01 : smprintf(s, "waiting for Security Code.\n"); *Data->SecurityStatus = SEC_SecurityCode; break;
+ case 0x07 :
+ case 0x02 : smprintf(s, "waiting for PIN.\n"); *Data->SecurityStatus = SEC_Pin; break;
+ case 0x03 : smprintf(s, "waiting for PUK.\n"); *Data->SecurityStatus = SEC_Puk; break;
+ case 0x05 : smprintf(s, "PIN ok, SIM ok\n"); *Data->SecurityStatus = SEC_None; break;
+ case 0x06 : smprintf(s, "No input status\n"); *Data->SecurityStatus = SEC_None; break;
+ case 0x16 : smprintf(s, "No SIM card\n"); return ERR_NOSIM;
+ case 0x1A : smprintf(s, "SIM card rejected!\n"); *Data->SecurityStatus = SEC_None; break;
+ default : smprintf(s, "ERROR: unknown %i\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetSecurityStatus(GSM_StateMachine *s, GSM_SecurityCodeType *Status)
+{
+ unsigned char req[5] = {N6110_FRAME_HEADER, 0x11, 0x00};
+
+ s->Phone.Data.SecurityStatus=Status;
+ smprintf(s, "Getting security code status\n");
+ return GSM_WaitFor (s, req, 5, 0x08, 2, ID_GetSecurityStatus);
+}
+
+static GSM_Error N6510_ReplyEnterSecurityCode(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[3]) {
+ case 0x08:
+ smprintf(s, "Security code OK\n");
+ return ERR_NONE;
+ case 0x09:
+ switch (msg->Buffer[4]) {
+ case 0x06:
+ smprintf(s, "Wrong PIN\n");
+ return ERR_SECURITYERROR;
+ case 0x09:
+ smprintf(s, "Wrong PUK\n");
+ return ERR_SECURITYERROR;
+ default:
+ smprintf(s, "ERROR: unknown security code status %i\n",msg->Buffer[4]);
+ }
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_EnterSecurityCode(GSM_StateMachine *s, GSM_SecurityCode *Code)
+{
+ int len = 0;
+ unsigned char req[15] = {N6110_FRAME_HEADER, 0x07,
+ 0x00}; /* Code type */
+
+ switch (Code->Type) {
+ case SEC_Pin : req[4] = 0x02; break;
+ case SEC_Puk : req[4] = 0x03; break;/* FIXME */
+ default : return ERR_NOTSUPPORTED;
+ }
+
+ len = strlen(Code->Code);
+ memcpy(req+5,Code->Code,len);
+ req[5+len]=0x00;
+
+ smprintf(s, "Entering security code\n");
+ return GSM_WaitFor (s, req, 6+len, 0x08, s->Phone.Data.Priv.N6510.Timeout, ID_EnterSecurityCode);
+}
+
+static GSM_Error N6510_ReplySaveSMSMessage(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ unsigned char folder;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg->Buffer[3]) {
+ case 0x01:
+ switch (msg->Buffer[4]) {
+ case 0x00:
+ smprintf(s, "Done OK\n");
+ break;
+ case 0x02:
+ smprintf(s, "Incorrect location\n");
+ return ERR_INVALIDLOCATION;
+ case 0x03:
+ smprintf(s, "Memory full (for example no empty space in SIM)\n");
+ return ERR_FULL;
+ case 0x05:
+ smprintf(s, "Incorrect folder\n");
+ return ERR_INVALIDLOCATION;
+ default:
+ smprintf(s, "ERROR: unknown reply on saving message %i\n",msg->Buffer[4]);
+ return ERR_UNKNOWNRESPONSE;
+ }
+
+ smprintf(s, "Folder info: %i %i\n",msg->Buffer[5],msg->Buffer[8]);
+ Data->SaveSMSMessage->Memory = MEM_ME;
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ folder = msg->Buffer[8];
+ } else {
+ folder = msg->Buffer[8] + 1;
+ /* inbox,outbox */
+ if (msg->Buffer[8] == 0x02 || msg->Buffer[8] == 0x03) {
+ if (msg->Buffer[5] == 0x01) {
+ folder = msg->Buffer[8] - 1;
+ Data->SaveSMSMessage->Memory = MEM_SM;
+ }
+ }
+ }
+ N6510_SetSMSLocation(s, Data->SaveSMSMessage,folder,msg->Buffer[6]*256+msg->Buffer[7]);
+ smprintf(s, "Saved in folder %i at location %i\n",folder, msg->Buffer[6]*256+msg->Buffer[7]);
+ Data->SaveSMSMessage->Folder = folder;
+ return ERR_NONE;
+ case 0x17:
+ smprintf(s, "SMS name changed\n");
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_PrivSetSMSMessage(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ int length = 11;
+ unsigned int location;
+ unsigned char folderid, folder;
+ GSM_SMSMessageLayout Layout;
+ GSM_Error error;
+ unsigned char req [300] = {
+ N6110_FRAME_HEADER, 0x00,
+ 0x01, /* 1 = SIM, 2 = ME */
+ 0x02, /* Folder */
+ 0x00, 0x01, /* Location */
+ 0x01}; /* SMS state */
+ unsigned char NameReq[200] = {
+ N6110_FRAME_HEADER, 0x16,
+ 0x01, /* 1 = SIM, 2 = ME */
+ 0x02, /* Folder */
+ 0x00, 0x01}; /* Location */
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SMS_FILES)) return ERR_NOTSUPPORTED;
+ }
+
+ N6510_GetSMSLocation(s, sms, &folderid, &location);
+ if (folderid == 0x99) return ERR_INVALIDLOCATION;
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ switch (folderid) {
+ case 0x02: req[4] = 0x02; req[5] = 0x02; break; /* inbox */
+ /* sms saved to sent items make problems later during reading */
+ /* case 0x03: req[4] = 0x02; req[5] = 0x03; break; //sent items */
+ default : return ERR_NOTSUPPORTED; /* at least 6111 doesn't support saving to other */
+ }
+ } else {
+ switch (folderid) {
+ case 0x01: req[5] = 0x02; break; /* INBOX SIM */
+ case 0x02: req[5] = 0x03; break; /* OUTBOX SIM */
+ default : req[5] = folderid - 1; req[4] = 0x02; break; /* ME folders */
+ }
+ }
+ req[6]=location / 256;
+ req[7]=location % 256;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ switch (sms->PDU) {
+ case SMS_Status_Report: /* this is SMS submit with delivery report request */
+ case SMS_Submit:
+ break;
+ case SMS_Deliver:
+ /* Sent items */
+ if (folderid == 0x03) sms->PDU = SMS_Submit;
+ break;
+ default:
+ return ERR_UNKNOWN;
+ }
+ } else {
+ switch (sms->PDU) {
+ case SMS_Status_Report: /* this is SMS submit with delivery report request */
+ case SMS_Submit:
+ /* Inbox */
+ if (folderid == 0x01 || folderid == 0x03) sms->PDU = SMS_Deliver;
+ break;
+ case SMS_Deliver:
+ /* SIM Outbox */
+ if (folderid == 0x02) sms->PDU = SMS_Submit;
+ break;
+ default:
+ return ERR_UNKNOWN;
+ }
+ if (sms->PDU == SMS_Deliver) {
+ switch (sms->State) {
+ case SMS_Sent : /* We use GSM_Read, because phone return error */
+ case SMS_Read : req[8] = 0x01; break;
+ case SMS_UnSent : /* We use GSM_UnRead, because phone return error */
+ case SMS_UnRead : req[8] = 0x03; break;
+ }
+ } else {
+ switch (sms->State) {
+ case SMS_Sent : /* We use GSM_Sent, because phone change folder */
+ case SMS_Read : req[8] = 0x05; break;
+ case SMS_UnSent : /* We use GSM_UnSent, because phone change folder */
+ case SMS_UnRead : req[8] = 0x07; break;
+ }
+ }
+ }
+ memset(req+9,0x00,sizeof(req) - 9);
+ error=N6510_EncodeSMSFrame(s, sms, req + 9, &Layout, &length);
+ if (error != ERR_NONE) return error;
+
+ s->Phone.Data.SaveSMSMessage=sms;
+ smprintf(s, "Saving sms\n");
+ error=GSM_WaitFor (s, req, length+9, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_SaveSMSMessage);
+ if (error != ERR_NONE) return error;
+
+ /* no adding to SIM SMS */
+ if (UnicodeLength(sms->Name)==0 || sms->Folder < 3) return ERR_NONE;
+
+ folder = sms->Folder;
+ sms->Folder = 0;
+ N6510_GetSMSLocation(s, sms, &folderid, &location);
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) {
+ switch (folderid) {
+ case 0x03: NameReq[4] = 0x02; NameReq[5] = 0x02; break; /* sent items */
+ case 0x02: NameReq[4] = 0x02; NameReq[5] = 0x03; break; /* inbox */
+ default : return ERR_NOTSUPPORTED; /* at least 6111 doesn't support saving to other */
+ }
+ } else {
+ switch (folderid) {
+ case 0x01: NameReq[5] = 0x02; break; /* INBOX SIM */
+ case 0x02: NameReq[5] = 0x03; break; /* OUTBOX SIM */
+ default : NameReq[5] = folderid - 1; NameReq[4] = 0x02; break; /* ME folders */
+ }
+ }
+ NameReq[6]=location / 256;
+ NameReq[7]=location % 256;
+ length = 8;
+ CopyUnicodeString(NameReq+length, sms->Name);
+ length = length+UnicodeLength(sms->Name)*2;
+ NameReq[length++] = 0;
+ NameReq[length++] = 0;
+ error=GSM_WaitFor (s, NameReq, length, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_SaveSMSMessage);
+ sms->Folder = folder;
+ return error;
+}
+
+static GSM_Error N6510_SetSMS(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ unsigned int location;
+ unsigned char folderid;
+
+ N6510_GetSMSLocation(s, sms, &folderid, &location);
+ if (location == 0) return ERR_INVALIDLOCATION;
+ return N6510_PrivSetSMSMessage(s, sms);
+}
+
+static GSM_Error N6510_AddSMS(GSM_StateMachine *s, GSM_SMSMessage *sms)
+{
+ unsigned int location;
+ unsigned char folderid;
+
+ N6510_GetSMSLocation(s, sms, &folderid, &location);
+ location = 0;
+ N6510_SetSMSLocation(s, sms, folderid, location);
+ return N6510_PrivSetSMSMessage(s, sms);
+}
+
+static GSM_Error N6510_ReplyGetDateTime(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "Date & time received\n");
+ if (msg->Buffer[4]==0x01) {
+ NOKIA_DecodeDateTime(s, msg->Buffer+10, s->Phone.Data.DateTime, TRUE, FALSE);
+ return ERR_NONE;
+ }
+ smprintf(s, "Not set in phone\n");
+ return ERR_EMPTY;
+}
+
+static GSM_Error N6510_GetDateTime(GSM_StateMachine *s, GSM_DateTime *date_time)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x0A, 0x00, 0x00};
+
+ s->Phone.Data.DateTime=date_time;
+ smprintf(s, "Getting date & time\n");
+ return GSM_WaitFor (s, req, 6, 0x19, s->Phone.Data.Priv.N6510.Timeout, ID_GetDateTime);
+}
+
+static GSM_Error N6510_ReplySetDateTime(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Date & time set\n");
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_SetDateTime(GSM_StateMachine *s, GSM_DateTime *date_time)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER,
+ 0x01, 0x00, 0x01, 0x01, 0x0c, 0x01, 0x03,
+ 0x00, 0x00, /* Year */
+ 0x08, 0x01, /* Month & Day */
+ 0x15, 0x1f, /* Hours & Minutes */
+ 0x2b, /* Second ? */
+ 0x00};
+
+ NOKIA_EncodeDateTime(s, req+10, date_time);
+ req[16] = date_time->Second;
+ smprintf(s, "Setting date & time\n");
+ return GSM_WaitFor (s, req, 18, 0x19, s->Phone.Data.Priv.N6510.Timeout, ID_SetDateTime);
+}
+
+static GSM_Error N6510_ReplyGetManufactureMonth(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ if (msg->Buffer[7] == 0x00) {
+ smprintf(s, "No SIM card\n");
+ return ERR_NOSIM;
+ } else {
+ sprintf(s->Phone.Data.PhoneString,"%02i/%04i",msg->Buffer[13],msg->Buffer[14]*256+msg->Buffer[15]);
+ return ERR_NONE;
+ }
+}
+
+static GSM_Error N6510_GetManufactureMonth(GSM_StateMachine *s, char *value)
+{
+ unsigned char req[6] = {0x00, 0x05, 0x02, 0x01, 0x00, 0x02};
+/* unsigned char req[6] = {0x00, 0x03, 0x04, 0x0B, 0x01, 0x00}; */
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) return ERR_NOTSUPPORTED;
+
+ s->Phone.Data.PhoneString=value;
+ smprintf(s, "Getting manufacture month\n");
+ return GSM_WaitFor (s, req, 6, 0x42, 2, ID_GetManufactureMonth);
+/* return GSM_WaitFor (s, req, 6, 0x1B, 2, ID_GetManufactureMonth); */
+}
+
+static GSM_Error N6510_ReplyGetAlarm(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch(msg->Buffer[3]) {
+ case 0x1A:
+ smprintf(s, " Alarm: %02d:%02d\n", msg->Buffer[14], msg->Buffer[15]);
+ Data->Alarm->Repeating = TRUE;
+ Data->Alarm->Text[0] = 0;
+ Data->Alarm->Text[1] = 0;
+ Data->Alarm->DateTime.Hour = msg->Buffer[14];
+ Data->Alarm->DateTime.Minute = msg->Buffer[15];
+ Data->Alarm->DateTime.Second = 0;
+ return ERR_NONE;
+ case 0x20:
+ smprintf(s, "Alarm state received\n");
+ if (msg->Buffer[37] == 0x01) {
+ smprintf(s, " Not set in phone\n");
+ return ERR_EMPTY;
+ }
+ smprintf(s, "Enabled\n");
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetAlarm(GSM_StateMachine *s, GSM_Alarm *Alarm)
+{
+ unsigned char StateReq[] = {N6110_FRAME_HEADER, 0x1f, 0x01, 0x00};
+ unsigned char GetReq [] = {N6110_FRAME_HEADER, 0x19, 0x00, 0x02};
+ GSM_Error error;
+
+ if (Alarm->Location != 1) return ERR_NOTSUPPORTED;
+
+ s->Phone.Data.Alarm=Alarm;
+ smprintf(s, "Getting alarm state\n");
+ error = GSM_WaitFor (s, StateReq, 6, 0x19, s->Phone.Data.Priv.N6510.Timeout, ID_GetAlarm);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Getting alarm\n");
+ return GSM_WaitFor (s, GetReq, 6, 0x19, s->Phone.Data.Priv.N6510.Timeout, ID_GetAlarm);
+}
+
+static GSM_Error N6510_ReplySetAlarm(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Alarm set\n");
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_SetAlarm(GSM_StateMachine *s, GSM_Alarm *Alarm)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER,
+ 0x11, 0x00, 0x01, 0x01, 0x0c, 0x02,
+ 0x01, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, /* Hours, Minutes */
+ 0x00, 0x00, 0x00 };
+
+ if (Alarm->Location != 1) return ERR_NOTSUPPORTED;
+
+ req[14] = Alarm->DateTime.Hour;
+ req[15] = Alarm->DateTime.Minute;
+
+ smprintf(s, "Setting alarm\n");
+ return GSM_WaitFor (s, req, 19, 0x19, s->Phone.Data.Priv.N6510.Timeout, ID_SetAlarm);
+}
+
+static GSM_Error N6510_ReplyGetRingtonesInfo(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int tmp,i;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Ringtones info received\n");
+ memset(Data->RingtonesInfo,0,sizeof(GSM_AllRingtonesInfo));
+ if (msg->Buffer[4] * 256 + msg->Buffer[5] == 0x00) return ERR_EMPTY;
+ Data->RingtonesInfo->Number = msg->Buffer[4] * 256 + msg->Buffer[5];
+ /* allocate array of ringtones based on number */
+ Data->RingtonesInfo->Ringtone = calloc(Data->RingtonesInfo->Number, sizeof(GSM_RingtoneInfo));
+ tmp = 6;
+ for (i=0;i<Data->RingtonesInfo->Number;i++) {
+ Data->RingtonesInfo->Ringtone[i].Group = msg->Buffer[tmp+4];
+ Data->RingtonesInfo->Ringtone[i].ID = msg->Buffer[tmp+2] * 256 + msg->Buffer[tmp+3];
+ memcpy(Data->RingtonesInfo->Ringtone[i].Name,msg->Buffer+tmp+8,(msg->Buffer[tmp+6]*256+msg->Buffer[tmp+7])*2);
+ smprintf(s, "%5i (%5i). \"%s\"\n",
+ Data->RingtonesInfo->Ringtone[i].ID,
+ Data->RingtonesInfo->Ringtone[i].Group,
+ DecodeUnicodeString(Data->RingtonesInfo->Ringtone[i].Name));
+ tmp = tmp + (msg->Buffer[tmp]*256+msg->Buffer[tmp+1]);
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_PrivGetRingtonesInfo(GSM_StateMachine *s, GSM_AllRingtonesInfo *Info, gboolean AllRingtones)
+{
+ GSM_Error error;
+ unsigned char UserReq[8] = {N7110_FRAME_HEADER, 0x07, 0x00, 0x00, 0x00, 0x02};
+/* unsigned char All_Req[9] = {N7110_FRAME_HEADER, 0x07, 0x00, 0x00, 0xFE, 0x00, 0x7D}; */
+ unsigned char All_Req[8] = {N7110_FRAME_HEADER, 0x07, 0x00, 0x00, 0x00, 0x00};
+
+ s->Phone.Data.RingtonesInfo=Info;
+ smprintf(s, "Getting binary ringtones ID\n");
+ if (AllRingtones) {
+/* error = GSM_WaitFor (s, All_Req, 9, 0x1f, s->Phone.Data.Priv.N6510.Timeout, ID_GetRingtonesInfo); */
+ error = GSM_WaitFor (s, All_Req, 8, 0x1f, s->Phone.Data.Priv.N6510.Timeout, ID_GetRingtonesInfo);
+ if (error == ERR_EMPTY && Info->Number == 0) return ERR_NOTSUPPORTED;
+ return error;
+ } else {
+ error = GSM_WaitFor (s, UserReq, 8, 0x1f, s->Phone.Data.Priv.N6510.Timeout, ID_GetRingtonesInfo);
+ if (error == ERR_EMPTY && Info->Number == 0) return ERR_NOTSUPPORTED;
+ return error;
+ }
+}
+
+static GSM_Error N6510_GetRingtonesInfo(GSM_StateMachine *s, GSM_AllRingtonesInfo *Info)
+{
+ return N6510_PrivGetRingtonesInfo(s, Info, TRUE);
+}
+
+static GSM_Error N6510_ReplyGetRingtone(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ size_t tmp,i;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ smprintf(s, "Ringtone received\n");
+ memcpy(Data->Ringtone->Name,msg->Buffer+8,msg->Buffer[7]*2);
+ Data->Ringtone->Name[msg->Buffer[7]*2]=0;
+ Data->Ringtone->Name[msg->Buffer[7]*2+1]=0;
+ smprintf(s, "Name \"%s\"\n",DecodeUnicodeString(Data->Ringtone->Name));
+ if (msg->Buffer[msg->Buffer[7]*2+10] == 'M' &&
+ msg->Buffer[msg->Buffer[7]*2+11] == 'T' &&
+ msg->Buffer[msg->Buffer[7]*2+12] == 'h' &&
+ msg->Buffer[msg->Buffer[7]*2+13] == 'd') {
+ smprintf(s,"MIDI\n");
+ tmp = msg->Buffer[7]*2+10;
+ i = msg->Length - 2; /* ?????? */
+ Data->Ringtone->Format = RING_MIDI;
+ } else {
+ /* Looking for end */
+ i=8+msg->Buffer[7]*2+3;
+ tmp = i;
+ while (TRUE) {
+ if (msg->Buffer[i]==0x07 && msg->Buffer[i+1]==0x0b) {
+ i=i+2; break;
+ }
+ i++;
+ if (i==msg->Length) return ERR_EMPTY;
+ }
+ }
+ /* Copying frame */
+ memcpy(Data->Ringtone->NokiaBinary.Frame,msg->Buffer+tmp,i-tmp);
+ Data->Ringtone->NokiaBinary.Length=i-tmp;
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetRingtone(GSM_StateMachine *s, GSM_Ringtone *Ringtone, gboolean PhoneRingtone)
+{
+ GSM_AllRingtonesInfo Info = {0, NULL};
+ GSM_Error error;
+ unsigned char req2[6] = {N7110_FRAME_HEADER, 0x12,
+ 0x00, 0xe7}; /* Location */
+
+ if (Ringtone->Format == 0x00) Ringtone->Format = RING_NOKIABINARY;
+
+ switch (Ringtone->Format) {
+ case RING_NOTETONE:
+ /* In the future get binary and convert */
+ return ERR_NOTSUPPORTED;
+ case RING_NOKIABINARY:
+ s->Phone.Data.Ringtone = Ringtone;
+ Info.Number = 0;
+ error=N6510_PrivGetRingtonesInfo(s, &Info, PhoneRingtone);
+ if (error != ERR_NONE) return error;
+ if (Ringtone->Location > Info.Number) return ERR_INVALIDLOCATION;
+ req2[4] = Info.Ringtone[Ringtone->Location-1].ID / 256;
+ req2[5] = Info.Ringtone[Ringtone->Location-1].ID % 256;
+ smprintf(s, "Getting binary ringtone\n");
+ error = GSM_WaitFor (s, req2, 6, 0x1f, s->Phone.Data.Priv.N6510.Timeout, ID_GetRingtone);
+ if (Info.Ringtone) {
+ free(Info.Ringtone);
+ Info.Ringtone=NULL;
+ }
+ return error;
+ case RING_MIDI:
+ case RING_MMF:
+ return ERR_NOTSUPPORTED;
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6510_PlayTone(GSM_StateMachine *s, int Herz, unsigned char Volume, gboolean start)
+{
+ GSM_Error error;
+ unsigned char reqStart[] = {
+ 0x00,0x06,0x01,0x00,0x07,0x00 };
+ unsigned char reqPlay[] = {
+ 0x00,0x06,0x01,0x14,0x05,0x04,
+ 0x00,0x00,0x00,0x03,0x03,0x08,
+ 0x00,0x00,0x00,0x01,0x00,0x00,
+ 0x03,0x08,0x01,0x00,
+ 0x07,0xd0, /*Frequency */
+ 0x00,0x00,0x03,0x08,0x02,0x00,0x00,
+ 0x05, /*Volume */
+ 0x00,0x00};
+ unsigned char reqOff[] = {
+ 0x00,0x06,0x01,0x14,0x05,0x05,
+ 0x00,0x00,0x00,0x01,0x03,0x08,
+ 0x05,0x00,0x00,0x08,0x00,0x00};
+/* unsigned char reqOff2[] = { */
+/* 0x00,0x06,0x01,0x14,0x05,0x04, */
+/* 0x00,0x00,0x00,0x01,0x03,0x08, */
+/* 0x00,0x00,0x00,0x00,0x00,0x00}; */
+
+ if (start) {
+ smprintf(s, "Enabling sound - part 1\n");
+ error=GSM_WaitFor (s, reqStart, 6, 0x0b, s->Phone.Data.Priv.N6510.Timeout, ID_PlayTone);
+ if (error!=ERR_NONE) return error;
+ smprintf(s, "Enabling sound - part 2 (disabling sound command)\n");
+ error=GSM_WaitFor (s, reqOff, 18, 0x0b, s->Phone.Data.Priv.N6510.Timeout, ID_PlayTone);
+ if (error!=ERR_NONE) return error;
+ }
+
+ /* For Herz==255*255 we have silent */
+ if (Herz!=255*255) {
+ reqPlay[23] = Herz%256;
+ reqPlay[22] = Herz/256;
+ reqPlay[31] = Volume;
+ smprintf(s, "Playing sound\n");
+ return GSM_WaitFor (s, reqPlay, 34, 0x0b, s->Phone.Data.Priv.N6510.Timeout, ID_PlayTone);
+ } else {
+ reqPlay[23] = 0;
+ reqPlay[22] = 0;
+ reqPlay[31] = 0;
+ smprintf(s, "Playing silent sound\n");
+ return GSM_WaitFor (s, reqPlay, 34, 0x0b, s->Phone.Data.Priv.N6510.Timeout, ID_PlayTone);
+
+/* smprintf(s, "Disabling sound - part 1\n"); */
+/* error=GSM_WaitFor (s, reqOff, 18, 0x0b, s->Phone.Data.Priv.N6510.Timeout, ID_PlayTone); */
+/* if (error!=ERR_NONE) return error; */
+/* smprintf(s, "Disabling sound - part 2\n"); */
+/* return GSM_WaitFor (s, reqOff2, 18, 0x0b, s->Phone.Data.Priv.N6510.Timeout, ID_PlayTone); */
+ }
+}
+
+static GSM_Error N6510_ReplyGetPPM(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Phone_Data *Data = &s->Phone.Data;
+ size_t pos = 6,len;
+
+ smprintf(s, "Received phone info\n");
+
+ while(pos < msg->Length) {
+ if (msg->Buffer[pos] == 0x55 && msg->Buffer[pos+1] == 0x55) {
+ while(1) {
+ if (msg->Buffer[pos] != 0x55) break;
+ pos++;
+ }
+ }
+ len = pos;
+ while(len < msg->Length) {
+ if (msg->Buffer[len] == 0x00 && msg->Buffer[len+1] == 0x00) break;
+ len++;
+ }
+ while(len < msg->Length) {
+ if (msg->Buffer[len] != 0x00) break;
+ len++;
+ }
+ len = len-pos;
+ smprintf(s, "Block with ID %02x",msg->Buffer[pos]);
+#ifdef DEBUG
+ if (s->di.dl == DL_TEXTALL || s->di.dl == DL_TEXTALLDATE) DumpMessage(&s->di, msg->Buffer+pos, len);
+#endif
+ switch (msg->Buffer[pos]) {
+ case 0x49:
+ smprintf(s, "hardware version\n");
+ break;
+ case 0x58:
+ pos += 3;
+ while (msg->Buffer[pos] != 0x00) pos++;
+ Data->PhoneString[0] = msg->Buffer[pos - 1];
+ Data->PhoneString[1] = 0x00;
+ smprintf(s, "PPM %s\n",Data->PhoneString);
+ return ERR_NONE;
+ default:
+ break;
+ }
+ pos += len;
+ }
+ return ERR_NOTSUPPORTED;
+}
+
+static GSM_Error N6510_GetPPM(GSM_StateMachine *s,char *value)
+{
+/* unsigned char req[6] = {N6110_FRAME_HEADER, 0x07, 0x01, 0xff}; */
+ unsigned char req[6] = {N6110_FRAME_HEADER, 0x07, 0x01, 0x00};
+
+ s->Phone.Data.PhoneString=value;
+ smprintf(s, "Getting PPM\n");
+ return GSM_WaitFor (s, req, 6, 0x1b, 3, ID_GetPPM);
+}
+
+static GSM_Error N6510_GetSpeedDial(GSM_StateMachine *s, GSM_SpeedDial *SpeedDial)
+{
+ GSM_MemoryEntry pbk;
+ GSM_Error error;
+
+ pbk.MemoryType = (GSM_MemoryType)MEM7110_SP;
+ pbk.Location = SpeedDial->Location;
+ SpeedDial->MemoryLocation = 0;
+ s->Phone.Data.SpeedDial = SpeedDial;
+
+ smprintf(s, "Getting speed dial\n");
+ error=N6510_GetMemory(s,&pbk);
+ switch (error) {
+ case ERR_NOTSUPPORTED:
+ smprintf(s, "No speed dials set in phone\n");
+ return ERR_EMPTY;
+ case ERR_NONE:
+ if (SpeedDial->MemoryLocation == 0) {
+ smprintf(s, "Speed dial not assigned or error in firmware\n");
+ return ERR_EMPTY;
+ }
+ return ERR_NONE;
+ default:
+ return error;
+ }
+}
+
+static GSM_Error N6510_ReplyGetProfile(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ unsigned char *blockstart;
+ int i,j;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg->Buffer[3]) {
+ case 0x02:
+ blockstart = msg->Buffer + 7;
+ for (i = 0; i < 11; i++) {
+ smprintf(s, "Profile feature %02x ",blockstart[1]);
+#ifdef DEBUG
+ if (s->di.dl == DL_TEXTALL || s->di.dl == DL_TEXTALLDATE) DumpMessage(&s->di, blockstart, blockstart[0]);
+#endif
+
+ switch (blockstart[1]) {
+ case 0x03:
+ smprintf(s, "Ringtone ID\n");
+ Data->Profile->FeatureID [Data->Profile->FeaturesNumber] = Profile_RingtoneID;
+ Data->Profile->FeatureValue [Data->Profile->FeaturesNumber] = blockstart[7];
+ if (blockstart[7] == 0x00) {
+ Data->Profile->FeatureValue[Data->Profile->FeaturesNumber] = blockstart[10];
+ }
+ Data->Profile->FeaturesNumber++;
+ break;
+ case 0x05: /* SMS tone */
+ j = Data->Profile->FeaturesNumber;
+ NOKIA_FindFeatureValue(s, Profile71_65,blockstart[1],blockstart[7],Data,FALSE);
+ if (j == Data->Profile->FeaturesNumber) {
+ Data->Profile->FeatureID [Data->Profile->FeaturesNumber] = Profile_MessageTone;
+ Data->Profile->FeatureValue [Data->Profile->FeaturesNumber] = PROFILE_MESSAGE_PERSONAL;
+ Data->Profile->FeaturesNumber++;
+ Data->Profile->FeatureID [Data->Profile->FeaturesNumber] = Profile_MessageToneID;
+ Data->Profile->FeatureValue [Data->Profile->FeaturesNumber] = blockstart[7];
+ Data->Profile->FeaturesNumber++;
+ }
+ break;
+ case 0x08: /* Caller groups */
+ NOKIA_FindFeatureValue(s, Profile71_65,blockstart[1],blockstart[7],Data,TRUE);
+ break;
+ case 0x0c :
+ CopyUnicodeString(Data->Profile->Name,blockstart + 7);
+ smprintf(s, "profile Name: \"%s\"\n", DecodeUnicodeString(Data->Profile->Name));
+ Data->Profile->DefaultName = FALSE;
+ break;
+ default:
+ NOKIA_FindFeatureValue(s, Profile71_65,blockstart[1],blockstart[7],Data,FALSE);
+ }
+ blockstart = blockstart + blockstart[0];
+ }
+ return ERR_NONE;
+ case 0x06:
+ Data->Profile->Active = FALSE;
+ if (Data->Profile->Location == msg->Buffer[5]) Data->Profile->Active = TRUE;
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetProfile(GSM_StateMachine *s, GSM_Profile *Profile)
+{
+ unsigned char req[150] = {N6110_FRAME_HEADER, 0x01, 0x01, 0x0C, 0x01};
+ unsigned char reqActive[] = {N6110_FRAME_HEADER, 0x05};
+ int i, length = 7;
+ GSM_Error error;
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES)) return ERR_NOTSUPPORTED;
+
+/* if (!strcmp(s->Phone.Data.ModelInfo->model,"3510")) { */
+/* if (s->Phone.Data.VerNum>3.37) return ERR_NOTSUPPORTED; */
+/* if (!strcmp(s->Phone.Data.ModelInfo->model,"6230")) { */
+/* if (!strcmp(s->Phone.Data.ModelInfo->model,"6220")) { */
+/* if (!strcmp(s->Phone.Data.ModelInfo->model,"5140")) { */
+/* if (!strcmp(s->Phone.Data.ModelInfo->model,"6230i")) { */
+/* if (!strcmp(s->Phone.Data.ModelInfo->model,"6020")) { */
+
+ if (Profile->Location>5) return ERR_INVALIDLOCATION;
+
+ for (i = 0; i < 0x0a; i++) {
+ req[length++] = 0x04;
+ req[length++] = Profile->Location;
+ req[length++] = i;
+ req[length++] = 0x01;
+ }
+
+ req[length++] = 0x04;
+ req[length++] = Profile->Location;
+ req[length++] = 0x0c;
+ req[length++] = 0x01;
+
+ req[length++] = 0x04;
+
+ Profile->CarKitProfile = FALSE;
+ Profile->HeadSetProfile = FALSE;
+
+ Profile->FeaturesNumber = 0;
+
+ s->Phone.Data.Profile=Profile;
+ smprintf(s, "Getting profile\n");
+ error = GSM_WaitFor (s, req, length, 0x39, s->Phone.Data.Priv.N6510.Timeout, ID_GetProfile);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Checking, which profile is active\n");
+ return GSM_WaitFor (s, reqActive, 4, 0x39, s->Phone.Data.Priv.N6510.Timeout, ID_GetProfile);
+}
+
+static GSM_Error N6510_ReplySetProfile(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ unsigned char *blockstart;
+ int i;
+
+ smprintf(s, "Response to profile writing received!\n");
+
+ blockstart = msg->Buffer + 6;
+ for (i = 0; i < msg->Buffer[5]; i++) {
+ switch (blockstart[2]) {
+ case 0x00: smprintf(s, "keypad tone level"); break;
+ case 0x02: smprintf(s, "call alert"); break;
+ case 0x03: smprintf(s, "ringtone"); break;
+ case 0x04: smprintf(s, "ringtone volume"); break;
+ case 0x05: smprintf(s, "SMS tone"); break;
+ case 0x06: smprintf(s, "vibration"); break;
+ case 0x07: smprintf(s, "warning tone level"); break;
+ case 0x08: smprintf(s, "caller groups"); break;
+ case 0x09: smprintf(s, "automatic answer"); break;
+ case 0x0c: smprintf(s, "name"); break;
+ default:
+ smprintf(s, "Unknown block type %02x", blockstart[2]);
+ break;
+ }
+ if (msg->Buffer[4] == 0x00) {
+ smprintf(s, ": set OK\n");
+ } else {
+ smprintf(s, ": setting error %i\n", msg->Buffer[4]);
+ }
+ blockstart = blockstart + blockstart[1];
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_SetProfile(GSM_StateMachine *s, GSM_Profile *Profile)
+{
+ int i, length = 7, blocks = 0;
+ gboolean found;
+ unsigned char ID,Value;
+ unsigned char req[150] = {N6110_FRAME_HEADER, 0x03, 0x01,
+ 0x06, /* Number of blocks */
+ 0x03};
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_PROFILES)) return ERR_NOTSUPPORTED;
+
+ if (Profile->Location>5) return ERR_INVALIDLOCATION;
+
+ for (i=0;i<Profile->FeaturesNumber;i++) {
+ found = FALSE;
+ switch (Profile->FeatureID[i]) {
+ case Profile_RingtoneID:
+ ID = 0x03;
+ Value = Profile->FeatureValue[i];
+ found = TRUE;
+ break;
+ default:
+ found=NOKIA_FindPhoneFeatureValue(
+ s,
+ Profile71_65,
+ Profile->FeatureID[i],Profile->FeatureValue[i],
+ &ID,&Value);
+ }
+ if (found) {
+ req[length] = 0x09;
+ req[length + 1] = ID;
+ req[length + 2] = Profile->Location;
+ memcpy(req + length + 4, "\x00\x00\x01", 3);
+ req[length + 8] = 0x03;
+ req[length + 3] = req[length + 7] = Value;
+ blocks++;
+ length += 9;
+ }
+ }
+
+ smprintf(s, "Setting profile\n");
+ return GSM_WaitFor (s, req, length, 0x39, s->Phone.Data.Priv.N6510.Timeout, ID_SetProfile);
+}
+
+static GSM_Error N6510_ReplyIncomingCB(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[3]) {
+ case 0x21:
+ smprintf(s, "Ignoring cell broadcast ok event\n");
+ break;
+ case 0x22:
+ smprintf(s, "Ignoring cell broadcast fail event\n");
+ break;
+ case 0x23:
+ smprintf(s, "Ignoring cell broadcast read event\n");
+ break;
+ default:
+ smprintf(s, "Ignoring cell broadcast event 0x%02x\n", msg->Buffer[3]);
+ break;
+ }
+ return ERR_NONE;
+}
+static GSM_Error N6510_ReplyIncomingSMS(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_SMSMessage sms;
+ size_t i;
+
+#ifdef DEBUG
+ smprintf(s, "SMS message received\n");
+ N6510_DecodeSMSFrame(s, &sms, msg->Buffer+10,&i);
+#endif
+
+ if (s->Phone.Data.EnableIncomingSMS && s->User.IncomingSMS!=NULL) {
+ GSM_SetDefaultSMSData(&sms);
+
+ sms.State = SMS_UnRead;
+ sms.InboxFolder = TRUE;
+
+ N6510_DecodeSMSFrame(s, &sms, msg->Buffer+10,&i);
+
+ s->User.IncomingSMS(s, &sms, s->User.IncomingSMSUserData);
+ }
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_DialVoice(GSM_StateMachine *s, char *number, GSM_CallShowNumber ShowNumber)
+{
+ unsigned int pos2 = 15;
+ unsigned int pos = 4;
+ unsigned char req2[100] = {N6110_FRAME_HEADER,0x01,
+ 0x00,0x02,0x07,0x04,
+ 0x01, /* 1 - voice, 2 - data */
+ 0x00,0x03,
+ 0x18, /* length of rest + 1 */
+ 0x00,0x00,0x00};
+ unsigned char req[100] = {N6110_FRAME_HEADER,0x01,
+ 0x0c}; /* Number length */
+ GSM_Error error;
+
+ /* USSD not supported */
+ if (number[0] == '*') return ERR_NOTSUPPORTED;
+ if (number[0] == '#') return ERR_NOTSUPPORTED;
+
+ req[pos++] = strlen(number);
+ EncodeUnicode(req+pos,number,strlen(number));
+ pos += strlen(number)*2;
+ req[pos++] = 0x05; /* call type: voice - 0x05, data - 0x01 */
+ req[pos++] = 0x01;
+ req[pos++] = 0x05;
+ req[pos++] = 0x00;
+ req[pos++] = 0x02;
+ req[pos++] = 0x00;
+ req[pos++] = 0x00;
+ 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;
+ }
+ smprintf(s, "Making voice call\n");
+ error = GSM_WaitFor (s, req, pos, 0x01, s->Phone.Data.Priv.N6510.Timeout, ID_DialVoice);
+ if (error != ERR_NOTSUPPORTED) return error;
+
+ if (ShowNumber != GSM_CALL_DefaultNumberPresence) return ERR_NOTSUPPORTED;
+
+ req2[11] = strlen(number)*2+6;
+ req2[pos2++] = strlen(number);
+ EncodeUnicode(req2+pos2,number,strlen(number));
+ pos2 += strlen(number)*2;
+
+ smprintf(s, "Making voice call\n");
+ error = GSM_WaitFor (s, req2, pos2, 0x01, s->Phone.Data.Priv.N6510.Timeout, ID_DialVoice);
+ if (error == ERR_NOTSUPPORTED) return ERR_NONE;
+ return error;
+}
+
+static GSM_Error N6510_ReplyLogIntoNetwork(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Probably phone says: I log into network\n");
+ return ERR_NONE;
+}
+
+void N6510_EncodeFMFrequency(double freq, unsigned char *buff)
+{
+ unsigned int freq2;
+
+ freq2 = (unsigned int)(freq * 100);
+ freq2 = freq2 - 0xffff;
+ buff[0] = freq2 / 0x100;
+ buff[1] = freq2 % 0x100;
+}
+
+void N6510_DecodeFMFrequency(double *freq, unsigned char *buff)
+{
+ *freq = (double)(0xffff + buff[0] * 0x100 + buff[1])/1000.0;
+}
+
+static GSM_Error N6510_ReplyGetFMStatus(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s, "getting FM status OK\n");
+ memcpy(s->Phone.Data.Priv.N6510.FMStatus,msg->Buffer,msg->Length);
+ s->Phone.Data.Priv.N6510.FMStatusLength = msg->Length;
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_GetFMStatus(GSM_StateMachine *s)
+{
+ unsigned char req[7] = {N6110_FRAME_HEADER, 0x0d, 0x00, 0x00, 0x01};
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_RADIO)) return ERR_NOTSUPPORTED;
+ return GSM_WaitFor (s, req, 7, 0x3E, 2, ID_GetFMStation);
+}
+
+static GSM_Error N6510_ReplyGetFMStation(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ unsigned char name[GSM_MAX_FMSTATION_LENGTH*2+2];
+ int length;
+ GSM_Phone_Data *Data = &s->Phone.Data;
+
+ switch (msg->Buffer[3]) {
+ case 0x06:
+ smprintf(s, "Received FM station\n");
+ length = msg->Buffer[8];
+ if (length > GSM_MAX_FMSTATION_LENGTH) {
+ smprintf(s, "FM station name too long (%d), truncating!\n", length);
+ length = GSM_MAX_FMSTATION_LENGTH;
+ }
+ memcpy(name,msg->Buffer+18,length*2);
+ name[length*2] = 0x00;
+ name[length*2+1] = 0x00;
+ CopyUnicodeString(Data->FMStation->StationName,name);
+ smprintf(s,"Station name: \"%s\"\n",DecodeUnicodeString(Data->FMStation->StationName));
+ N6510_DecodeFMFrequency(&Data->FMStation->Frequency, msg->Buffer+16);
+ return ERR_NONE;
+ case 0x16:
+ smprintf(s, "Received FM station. Empty ?\n");
+ return ERR_EMPTY;
+ case 0xf0:
+ smprintf(s, "FM radio not supported\n");
+ return ERR_NOTSUPPORTED;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetFMStation (GSM_StateMachine *s, GSM_FMStation *FMStation)
+{
+ GSM_Error error;
+ int location;
+ unsigned char req[7] = {N6110_FRAME_HEADER, 0x05,
+ 0x00, /* location */
+ 0x00,0x01};
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_RADIO)) return ERR_NOTSUPPORTED;
+ if (FMStation->Location > GSM_MAX_FM_STATION) return ERR_INVALIDLOCATION;
+
+ s->Phone.Data.FMStation = FMStation;
+
+ error = N6510_GetFMStatus(s);
+ if (error != ERR_NONE) return error;
+
+ location = FMStation->Location-1;
+ if (s->Phone.Data.Priv.N6510.FMStatus[14+location] == 0xFF) return ERR_EMPTY;
+ req[4] = s->Phone.Data.Priv.N6510.FMStatus[14+location];
+
+ smprintf(s, "Getting FM Station %i\n",FMStation->Location);
+ return GSM_WaitFor (s, req, 7, 0x3E, 2, ID_GetFMStation);
+}
+
+static GSM_Error N6510_ReplySetFMStation(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+#ifdef DEBUG
+ switch (msg->Buffer[4]){
+ case 0x03: smprintf(s, "FM stations cleaned\n"); break;
+ case 0x11: smprintf(s, "Setting FM station status OK\n"); break;
+ case 0x12: smprintf(s, "Setting FM station OK\n"); break;
+ }
+#endif
+ return ERR_NONE;
+}
+
+static GSM_Error N6510_ClearFMStations (GSM_StateMachine *s)
+{
+ unsigned char req[7] = {N6110_FRAME_HEADER, 0x03,0x0f,0x00,0x01};
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_RADIO)) return ERR_NOTSUPPORTED;
+
+ smprintf(s, "Cleaning FM Stations\n");
+ return GSM_WaitFor (s, req, 7, 0x3E, 2, ID_SetFMStation);
+}
+
+static GSM_Error N6510_SetFMStation (GSM_StateMachine *s, GSM_FMStation *FMStation)
+{
+ unsigned int len, location;
+ GSM_Error error;
+ unsigned char setstatus[36] = {N6110_FRAME_HEADER,0x11,0x00,0x01,0x01,
+ 0x00,0x00,0x1c,0x00,0x14,0x00,0x00,
+ 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
+ 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
+ 0xff,0xff,0xff,0xff,0xff,0x01};
+ unsigned char req[64] = {N6110_FRAME_HEADER, 0x12,0x00,0x01,0x00,
+ 0x00, /* 0x0e + (strlen(name) * 2) */
+ 0x00, /* strlen(name) */
+ 0x14,0x09,0x00,
+ 0x00, /* location */
+ 0x00,0x00,0x01,
+ 0x00, /* freqHi */
+ 0x00, /* freqLo */
+ 0x01};
+
+ if (!GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_RADIO)) return ERR_NOTSUPPORTED;
+
+ s->Phone.Data.FMStation = FMStation;
+ location = FMStation->Location-1;
+
+ error = N6510_GetFMStatus(s);
+ if (error != ERR_NONE) return error;
+
+ memcpy(setstatus+14,s->Phone.Data.Priv.N6510.FMStatus+14,20);
+ setstatus [14+location] = location;
+
+ smprintf(s, "Setting FM status %i\n",FMStation->Location);
+ error = GSM_WaitFor (s, setstatus, 36 , 0x3E, 2, ID_SetFMStation);
+ if (error != ERR_NONE) return error;
+
+ req[12] = location;
+
+ /* Name */
+ len = UnicodeLength(FMStation->StationName);
+ req[8] = len;
+ req[7] = 0x0e + len * 2;
+ memcpy (req+18,FMStation->StationName,len*2);
+
+ /* Frequency */
+ N6510_EncodeFMFrequency(FMStation->Frequency, req+16);
+
+ smprintf(s, "Setting FM Station %i\n",FMStation->Location);
+ return GSM_WaitFor (s, req, 0x13+len*2, 0x3E, 2, ID_SetFMStation);
+}
+
+static GSM_Error N6510_ReplySetLight(GSM_Protocol_Message *msg UNUSED, GSM_StateMachine *s)
+{
+ smprintf(s, "Light set\n");
+ return ERR_NONE;
+}
+
+GSM_Error N6510_SetLight(GSM_StateMachine *s, N6510_PHONE_LIGHTS light, gboolean enable)
+{
+ unsigned char req[14] = {
+ N6110_FRAME_HEADER, 0x05,
+ 0x01, /* 0x01 = Display, 0x03 = keypad */
+ 0x01, /* 0x01 = Enable, 0x02 = disable */
+ 0x00, 0x00, 0x00, 0x01,
+ 0x05, 0x04, 0x02, 0x00};
+
+ req[4] = light;
+ if (!enable) req[5] = 0x02;
+ smprintf(s, "Setting light\n");
+ return GSM_WaitFor (s, req, 14, 0x3A, s->Phone.Data.Priv.N6510.Timeout, ID_SetLight);
+}
+
+static GSM_Error N6510_ShowStartInfo(GSM_StateMachine *s, gboolean enable)
+{
+ GSM_Error error;
+
+ if (enable) {
+ error=N6510_SetLight(s,N6510_LIGHT_DISPLAY,TRUE);
+ if (error != ERR_NONE) return error;
+
+ error=N6510_SetLight(s,N6510_LIGHT_TORCH,TRUE);
+ if (error != ERR_NONE) return error;
+
+ return N6510_SetLight(s,N6510_LIGHT_KEYPAD,TRUE);
+ } else {
+ error=N6510_SetLight(s,N6510_LIGHT_DISPLAY,FALSE);
+ if (error != ERR_NONE) return error;
+
+ error=N6510_SetLight(s,N6510_LIGHT_TORCH,FALSE);
+ if (error != ERR_NONE) return error;
+
+ return N6510_SetLight(s,N6510_LIGHT_KEYPAD,FALSE);
+ }
+}
+
+static GSM_Error N6510_ReplyGetGPRSAccessPoint(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_GPRSAccessPoint *point = s->Phone.Data.GPRSPoint;
+
+ switch (msg->Buffer[13]) {
+ case 0x01:
+ smprintf(s,"Active GPRS point received\n");
+ point->Active = FALSE;
+ if (point->Location == msg->Buffer[18]) point->Active = TRUE;
+ return ERR_NONE;
+ case 0xD2:
+ smprintf(s,"Names for GPRS points received\n");
+ CopyUnicodeString(point->Name,msg->Buffer+18+(point->Location-1)*42);
+ smprintf(s,"\"%s\"\n",DecodeUnicodeString(point->Name));
+ return ERR_NONE;
+ case 0xF2:
+ smprintf(s,"URL for GPRS points received\n");
+ CopyUnicodeString(point->URL,msg->Buffer+18+(point->Location-1)*202);
+ smprintf(s,"\"%s\"\n",DecodeUnicodeString(point->URL));
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetGPRSAccessPoint(GSM_StateMachine *s, GSM_GPRSAccessPoint *point)
+{
+ GSM_Error error;
+ unsigned char URL[] = {
+ N7110_FRAME_HEADER, 0x05, 0x00, 0x00, 0x00, 0x2C, 0x00,
+ 0x00, 0x00, 0x00, 0x03, 0xF2, 0x00, 0x00};
+ unsigned char Name[] = {
+ N7110_FRAME_HEADER, 0x05, 0x00, 0x00, 0x00, 0x2C, 0x00,
+ 0x01, 0x00, 0x00, 0x00, 0xD2, 0x00, 0x00};
+ unsigned char Active[] = {
+ N7110_FRAME_HEADER, 0x05, 0x00, 0x00, 0x00, 0x2C, 0x00,
+ 0x02, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00};
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOGPRSPOINT)) return ERR_NOTSUPPORTED;
+ if (point->Location < 1) return ERR_UNKNOWN;
+ if (point->Location > 5) return ERR_INVALIDLOCATION;
+
+ s->Phone.Data.GPRSPoint = point;
+
+ smprintf(s, "Getting GPRS access point name\n");
+ error=GSM_WaitFor (s, Name, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_GetGPRSPoint);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Getting GPRS access point URL\n");
+ error=GSM_WaitFor (s, URL, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_GetGPRSPoint);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Getting number of active GPRS access point\n");
+ error=GSM_WaitFor (s, Active, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_GetGPRSPoint);
+ if (error != ERR_NONE) return error;
+
+ if (UnicodeLength(point->URL)==0 && UnicodeLength(point->Name)==0) return ERR_EMPTY;
+ return error;
+}
+
+static GSM_Error N6510_ReplySetGPRSAccessPoint1(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ switch (msg->Buffer[13]) {
+ case 0x01:
+ case 0xD2:
+ case 0xF2:
+ memcpy(s->Phone.Data.Priv.N6510.GPRSPoints,msg->Buffer,msg->Length);
+ s->Phone.Data.Priv.N6510.GPRSPointsLength = msg->Length;
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_SetGPRSAccessPoint(GSM_StateMachine *s, GSM_GPRSAccessPoint *point)
+{
+ unsigned char *buff = s->Phone.Data.Priv.N6510.GPRSPoints;
+ GSM_Error error;
+ unsigned char URL[] = {
+ N7110_FRAME_HEADER, 0x05, 0x00, 0x00, 0x00, 0x2C, 0x00,
+ 0x00, 0x00, 0x00, 0x03, 0xF2, 0x00, 0x00};
+ unsigned char Name[] = {
+ N7110_FRAME_HEADER, 0x05, 0x00, 0x00, 0x00, 0x2C, 0x00,
+ 0x01, 0x00, 0x00, 0x00, 0xD2, 0x00, 0x00};
+ unsigned char Active[] = {
+ N7110_FRAME_HEADER, 0x05, 0x00, 0x00, 0x00, 0x2C, 0x00,
+ 0x02, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00};
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_NOGPRSPOINT)) return ERR_NOTSUPPORTED;
+ if (point->Location < 1) return ERR_UNKNOWN;
+ if (point->Location > 5) return ERR_INVALIDLOCATION;
+
+ s->Phone.Data.GPRSPoint = point;
+
+ smprintf(s, "Getting GPRS access point name\n");
+ error=GSM_WaitFor (s, Name, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetGPRSPoint);
+ if (error != ERR_NONE) return error;
+ CopyUnicodeString(buff+18+(point->Location-1)*42,point->Name);
+ buff[0] = 0x00;
+ buff[1] = 0x01;
+ buff[2] = 0x01;
+ buff[3] = 0x07;
+ smprintf(s, "Setting GPRS access point name\n");
+ error=GSM_WaitFor (s, buff, s->Phone.Data.Priv.N6510.GPRSPointsLength, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetGPRSPoint);
+ if (error != ERR_NONE) return error;
+
+ smprintf(s, "Getting GPRS access point URL\n");
+ error=GSM_WaitFor (s, URL, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetGPRSPoint);
+ if (error != ERR_NONE) return error;
+ CopyUnicodeString(buff+18+(point->Location-1)*42,point->URL);
+ buff[0] = 0x00;
+ buff[1] = 0x01;
+ buff[2] = 0x01;
+ buff[3] = 0x07;
+ smprintf(s, "Setting GPRS access point URL\n");
+ error=GSM_WaitFor (s, buff, s->Phone.Data.Priv.N6510.GPRSPointsLength, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetGPRSPoint);
+ if (error != ERR_NONE) return error;
+
+ if (point->Active) {
+ smprintf(s, "Getting number of active GPRS access point\n");
+ error=GSM_WaitFor (s, Active, 16, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetGPRSPoint);
+ if (error != ERR_NONE) return error;
+ buff[0] = 0x00;
+ buff[1] = 0x01;
+ buff[2] = 0x01;
+ buff[3] = 0x07;
+ buff[18]= point->Location;
+ smprintf(s, "Setting number of active GPRS access point\n");
+ error=GSM_WaitFor (s, buff, s->Phone.Data.Priv.N6510.GPRSPointsLength, 0x43, s->Phone.Data.Priv.N6510.Timeout, ID_SetGPRSPoint);
+ if (error != ERR_NONE) return error;
+ }
+
+ return error;
+}
+
+static GSM_Error N6510_ReplyGetLocale(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ GSM_Locale *locale = s->Phone.Data.Locale;
+
+ switch (msg->Buffer[3]) {
+ case 0x8A:
+ smprintf(s, "Date settings received\n");
+ switch (msg->Buffer[4]) {
+ case 0x00:
+ locale->DateFormat = GSM_Date_DDMMYYYY;
+ locale->DateSeparator = '.';
+ break;
+ case 0x01:
+ locale->DateFormat = GSM_Date_MMDDYYYY;
+ locale->DateSeparator = '.';
+ break;
+ case 0x02:
+ locale->DateFormat = GSM_Date_YYYYMMDD;
+ locale->DateSeparator = '.';
+ break;
+ case 0x04:
+ locale->DateFormat = GSM_Date_DDMMYYYY;
+ locale->DateSeparator = '/';
+ break;
+ case 0x05:
+ locale->DateFormat = GSM_Date_MMDDYYYY;
+ locale->DateSeparator = '/';
+ break;
+ case 0x06:
+ locale->DateFormat = GSM_Date_YYYYMMDD;
+ locale->DateSeparator = '/';
+ break;
+ case 0x08:
+ locale->DateFormat = GSM_Date_DDMMYYYY;
+ locale->DateSeparator = '-';
+ break;
+ case 0x09:
+ locale->DateFormat = GSM_Date_MMDDYYYY;
+ locale->DateSeparator = '-';
+ break;
+ case 0x0A:
+ locale->DateFormat = GSM_Date_YYYYMMDD;
+ locale->DateSeparator = '-';
+ break;
+ default:/* FIXME */
+ locale->DateFormat = GSM_Date_DDMMYYYY;
+ locale->DateSeparator = '/';
+ break;
+ }
+ return ERR_NONE;
+ }
+ return ERR_UNKNOWNRESPONSE;
+}
+
+static GSM_Error N6510_GetLocale(GSM_StateMachine *s, GSM_Locale *locale)
+{
+ unsigned char req[] = {N6110_FRAME_HEADER, 0x89};
+
+ s->Phone.Data.Locale = locale;
+
+ smprintf(s, "Getting date format\n");
+ return GSM_WaitFor (s, req, 4, 0x13, s->Phone.Data.Priv.N6510.Timeout, ID_GetLocale);
+}
+
+GSM_Error N6510_CancelCall(GSM_StateMachine *s, int ID, gboolean all)
+{
+ if (all) return ERR_NOTSUPPORTED;
+ return DCT3DCT4_CancelCall(s,ID);
+}
+
+GSM_Error N6510_AnswerCall(GSM_StateMachine *s, int ID, gboolean all)
+{
+ if (all) return ERR_NOTSUPPORTED;
+ return DCT3DCT4_AnswerCall(s,ID);
+}
+
+static GSM_Error N6510_ReplyAddSMSFolder(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ smprintf(s,"SMS folder \"%s\" has been added\n",DecodeUnicodeString(msg->Buffer+10));
+ return ERR_NONE;
+}
+
+GSM_Error N6510_AddSMSFolder(GSM_StateMachine *s, unsigned char *name)
+{
+ unsigned char req[200] = {N6110_FRAME_HEADER, 0x10, 0x01, 0x00, 0x01,
+ 0x00, /* Length */
+ 0x00, 0x00};
+
+ CopyUnicodeString(req+10,name);
+ req[7] = UnicodeLength(name)*2 + 6;
+
+ smprintf(s, "Adding SMS folder\n");
+ return GSM_WaitFor (s, req, req[7] + 6, 0x14, s->Phone.Data.Priv.N6510.Timeout, ID_AddSMSFolder);
+}
+
+static GSM_Error N6510_SetWAPBookmark(GSM_StateMachine *s, GSM_WAPBookmark *bookmark)
+{
+ GSM_Error error;
+ int count=4, location;
+ unsigned char req[600] = {N6110_FRAME_HEADER, 0x09};
+
+ /* We have to enable WAP frames in phone */
+ error=N6510_EnableConnectionFunctions(s,N6510_WAP_SETTINGS);
+ if (error!=ERR_NONE) return error;
+
+ location = bookmark->Location - 1;
+ if (bookmark->Location == 0) location = 0xffff;
+ req[count++] = (location & 0xff00) >> 8;
+ req[count++] = location & 0x00ff;
+
+ count += NOKIA_SetUnicodeString(s, req+count, bookmark->Title, TRUE);
+ count += NOKIA_SetUnicodeString(s, req+count, bookmark->Address, TRUE);
+
+ req[count++] = 0x00;
+ req[count++] = 0x00;
+ req[count++] = 0x00;
+ req[count++] = 0x00;
+
+ smprintf(s, "Setting WAP bookmark\n");
+ error = GSM_WaitFor (s, req, count, 0x3f, s->Phone.Data.Priv.N6510.Timeout, ID_SetWAPBookmark);
+ if (error != ERR_NONE) {
+ if (error == ERR_INSIDEPHONEMENU || error == ERR_EMPTY || error == ERR_FULL) {
+ DCT3DCT4_DisableConnectionFunctions(s);
+ }
+ return error;
+ }
+
+ return DCT3DCT4_DisableConnectionFunctions(s);
+}
+
+GSM_Error N6510_DeleteWAPBookmark(GSM_StateMachine *s, GSM_WAPBookmark *bookmark)
+{
+ GSM_Error error;
+
+ /* We have to enable WAP frames in phone */
+ error=N6510_EnableConnectionFunctions(s,N6510_WAP_SETTINGS);
+ if (error!=ERR_NONE) return error;
+
+ return DCT3DCT4_DeleteWAPBookmarkPart(s,bookmark);
+}
+
+GSM_Error N6510_GetWAPBookmark(GSM_StateMachine *s, GSM_WAPBookmark *bookmark)
+{
+ GSM_Error error;
+
+ if (GSM_IsPhoneFeatureAvailable(s->Phone.Data.ModelInfo, F_SERIES40_30)) return ERR_NOTSUPPORTED;
+
+ /* We have to enable WAP frames in phone */
+ error=N6510_EnableConnectionFunctions(s,N6510_WAP_SETTINGS);
+ if (error!=ERR_NONE) return error;
+
+ return DCT3DCT4_GetWAPBookmarkPart(s,bookmark);
+}
+
+static GSM_Error DCT4_ReplyGetScreenDump(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ int len;
+
+ /* Data is at offset 10 */
+
+ len = msg->Buffer[7] | (msg->Buffer[6] << 8);
+ smprintf(s, "Received screenshot part, length %d\n", len);
+ s->Phone.Data.Picture->Buffer = realloc(s->Phone.Data.Picture->Buffer, s->Phone.Data.Picture->Length + len);
+ if (s->Phone.Data.Picture->Buffer == NULL) {
+ return ERR_MOREMEMORY;
+ }
+ memcpy(s->Phone.Data.Picture->Buffer + s->Phone.Data.Picture->Length, msg->Buffer + 10, len);
+ s->Phone.Data.Picture->Length += len;
+ if (len < 500) {
+ return ERR_NONE;
+ }
+ return ERR_NEEDANOTHERANSWER;
+}
+
+static GSM_Error DCT4_ReplyGetScreenInfo(GSM_Protocol_Message *msg, GSM_StateMachine *s)
+{
+ s->Phone.Data.Priv.N6510.ScreenWidth = msg->Buffer[5] | (msg->Buffer[4] << 8);
+ s->Phone.Data.Priv.N6510.ScreenHeight = msg->Buffer[7] | (msg->Buffer[6] << 8);
+ smprintf(s, "Screen size %dx%d\n", s->Phone.Data.Priv.N6510.ScreenWidth, s->Phone.Data.Priv.N6510.ScreenHeight);
+
+ return ERR_NONE;
+}
+
+GSM_Error DCT4_Screenshot(GSM_StateMachine *s, GSM_BinaryPicture *picture)
+{
+ unsigned char req_data[] = {N6110_FRAME_HEADER, 0x07, 0x01, 0x00};
+ unsigned char req_screen[] = {N6110_FRAME_HEADER, 0x06, 0x01, 0x00};
+ unsigned char bmp_header[] = {0x42, 0x4D, /* BMP magic "BM" */
+ 0, 0, 0, 0, /* Size of BMP in bytes */
+ 0, 0, 0, 0, /* reserved */
+ 0x7a, 0, 0, 0 , /* Offset of data */
+ 0x6c, 0, 0, 0, /* Size of header */
+ 0, 0, 0, 0, /* width */
+ 0, 0, 0, 0, /* height */
+ 1, 0, /* color planes */
+ 32, 0, /* bpp */
+ 3, 0, 0, 0, /* compression, BI_BITFIELDS */
+ 32, 0, 0, 0, /* Size of image pixel */
+ 0x13,0x0b,0x00,0x00, /* XPelsPerMeter */
+ 0x13,0x0b,0x00,0x00, /* YPelsPerMeter */
+ 0, 0, 0, 0, /* palette */
+ 0, 0, 0, 0, /* important colors */
+ 0, 0xFF, 0, 0, /* red mask */
+ 0, 0, 0xFF, 0, /* green mask */
+ 0, 0, 0, 0xFF, /* blue mask */
+ 0xFF, 0, 0, 0, /* alpha mask */
+ 0x20, 0x6E, 0x69, 0x57, /* LCS_WINDOWS_COLOR_SPACE */
+ 0, 0, 0, 0, /* CIEXYZTRIPLE */
+ 0, 0, 0, 0,
+ 0, 0, 0, 0,
+ 0, 0, 0, 0,
+ 0, 0, 0, 0,
+ 0, 0, 0, 0,
+ 0, 0, 0, 0,
+ 0, 0, 0, 0,
+ 0, 0, 0, 0,
+ 0, 0, 0, 0, /* red gamma */
+ 0, 0, 0, 0, /* green gamma */
+ 0, 0, 0, 0, /* blue gamma */
+ };
+ GSM_Error error;
+ int tmp;
+
+ /* Get screen size */
+ error = GSM_WaitFor(s, req_screen, 6, 0x0E, 4, ID_GetScreenSize);
+ if (error != ERR_NONE) {
+ return error;
+ }
+
+ /* Allocate buffer */
+ s->Phone.Data.Picture = picture;
+ picture->Type = PICTURE_BMP;
+ picture->Buffer = malloc(sizeof(bmp_header));
+ if (picture->Buffer == NULL) {
+ return ERR_MOREMEMORY;
+ }
+ memcpy(picture->Buffer, bmp_header, sizeof(bmp_header));
+ picture->Length = sizeof(bmp_header);
+
+ /* Fill BMP header */
+#define STORE_INT(data, pos) picture->Buffer[pos] = data & 0xff; picture->Buffer[pos + 1] = (data >> 8) & 0xff; picture->Buffer[pos + 2] = (data >> 16) & 0xff; picture->Buffer[pos + 3] = (data >> 24) & 0xff;
+ /* Size */
+ tmp = 0x7a + (s->Phone.Data.Priv.N6510.ScreenWidth * s->Phone.Data.Priv.N6510.ScreenHeight * 4);
+ STORE_INT(tmp, 2);
+ tmp = s->Phone.Data.Priv.N6510.ScreenWidth;
+ STORE_INT(tmp, 18);
+ tmp = -s->Phone.Data.Priv.N6510.ScreenHeight;
+ STORE_INT(tmp, 22);
+
+ /* And fill in bitmap */
+ return GSM_WaitFor(s, req_data, 6, 0x0E, 4, ID_Screenshot);
+}
+
+
+static GSM_Reply_Function N6510ReplyFunctions[] = {
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x02,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x03,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x04,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x05,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x07,ID_AnswerCall },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x07,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x09,ID_CancelCall },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x09,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x0A,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x0B,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x0C,ID_DialVoice },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x0C,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x0F,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x10,ID_DialVoice },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x10,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x23,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x25,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x27,ID_IncomingFrame },
+ {N71_65_ReplySendDTMF, "\x01",0x03,0x51,ID_SendDTMF },
+ {N71_65_ReplySendDTMF, "\x01",0x03,0xf0,ID_SendDTMF },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0x53,ID_IncomingFrame },
+ {N71_65_ReplySendDTMF, "\x01",0x03,0x59,ID_SendDTMF },
+ {N71_65_ReplySendDTMF, "\x01",0x03,0x5E,ID_SendDTMF },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0xA6,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0xD2,ID_IncomingFrame },
+ {N71_65_ReplyCallInfo, "\x01",0x03,0xD3,ID_IncomingFrame },
+ {N6510_ReplyPressKey, "\x01",0x03,0x33,ID_PressKey },
+ {N6510_ReplyPressKey, "\x01",0x03,0x12,ID_PressKey },
+
+ {N6510_ReplySendSMSMessage, "\x02",0x03,0x03,ID_IncomingFrame },
+ {N6510_ReplyIncomingSMS, "\x02",0x03,0x04,ID_IncomingFrame },
+ {N6510_ReplySetSMSC, "\x02",0x03,0x13,ID_SetSMSC },
+ {N6510_ReplyGetSMSC, "\x02",0x03,0x15,ID_GetSMSC },
+ {N6510_ReplyIncomingCB, "\x02",0x03,0x21,ID_IncomingFrame },
+ {N6510_ReplyIncomingCB, "\x02",0x03,0x22,ID_IncomingFrame },
+ {N6510_ReplyIncomingCB, "\x02",0x03,0x23,ID_IncomingFrame },
+
+ {N6510_ReplyGetMemoryStatus, "\x03",0x03,0x04,ID_GetMemoryStatus },
+ {N6510_ReplyGetMemory, "\x03",0x03,0x08,ID_GetMemory },
+ {N71_65_ReplyWritePhonebook, "\x03",0x03,0x0C,ID_SetBitmap },
+ {N71_65_ReplyWritePhonebook, "\x03",0x03,0x0C,ID_SetMemory },
+ {N6510_ReplyDeleteMemory, "\x03",0x03,0x10,ID_SetMemory },
+
+ {DCT3DCT4_ReplyCallDivert, "\x06",0x03,0x02,ID_Divert },
+ {N71_65_ReplyUSSDInfo, "\x06",0x03,0x03,ID_IncomingFrame },
+ {NoneReply, "\x06",0x03,0x06,ID_IncomingFrame },
+ {NoneReply, "\x06",0x03,0x09,ID_IncomingFrame },
+
+ {N6510_ReplyEnterSecurityCode, "\x08",0x03,0x08,ID_EnterSecurityCode },
+ {N6510_ReplyEnterSecurityCode, "\x08",0x03,0x09,ID_EnterSecurityCode },
+ {N6510_ReplyGetSecurityStatus, "\x08",0x03,0x12,ID_GetSecurityStatus },
+ {N6510_ReplyGetSecurityStatus, "\x08",0x03,0xf0,ID_GetSecurityStatus },
+
+ {N6510_ReplyGetNetworkInfo, "\x0A",0x03,0x01,ID_GetNetworkInfo },
+ {N6510_ReplyGetNetworkInfo, "\x0A",0x03,0xf0,ID_GetNetworkInfo },
+ {N6510_ReplyGetSignalQuality, "\x0A",0x03,0x0C,ID_GetSignalQuality },
+ {N6510_ReplyGetOperatorLogo, "\x0A",0x03,0x24,ID_GetBitmap },
+ {N6510_ReplyGetOperatorLogo, "\x0A",0x03,0xf0,ID_GetBitmap },
+ {N6510_ReplySetOperatorLogo, "\x0A",0x03,0x26,ID_SetBitmap },
+ /* This needs to be last of type */
+ {N6510_ReplyGetNetworkInfo, "\x0A",0x03,0x01,ID_IncomingFrame },
+ {N6510_ReplyLogIntoNetwork, "\x0A",0x03,0x02,ID_IncomingFrame },
+ {NoneReply, "\x0A",0x03,0x16,ID_IncomingFrame },
+ {N6510_ReplyGetIncSignalQuality, "\x0A",0x03,0x1E,ID_IncomingFrame },
+ {NoneReply, "\x0A",0x03,0x20,ID_IncomingFrame },
+ {N6510_ReplyGetNetworkInfo, "\x0A",0x03,0xf0,ID_IncomingFrame },
+
+ {NoneReply, "\x0B",0x03,0x01,ID_PlayTone },
+ {NoneReply, "\x0B",0x03,0x15,ID_PlayTone },
+ {NoneReply, "\x0B",0x03,0x16,ID_PlayTone },
+
+ {N71_65_ReplyAddCalendar1, "\x13",0x03,0x02,ID_SetCalendarNote },
+ {N71_65_ReplyAddCalendar1, "\x13",0x03,0x04,ID_SetCalendarNote },
+ {N71_65_ReplyAddCalendar1, "\x13",0x03,0x06,ID_SetCalendarNote },
+ {N71_65_ReplyAddCalendar1, "\x13",0x03,0x08,ID_SetCalendarNote },
+ {N71_65_ReplyDelCalendar, "\x13",0x03,0x0C,ID_DeleteCalendarNote },
+ {N71_65_ReplyDelCalendar, "\x13",0x03,0xF0,ID_DeleteCalendarNote },
+ {N71_65_ReplyGetNextCalendar1, "\x13",0x03,0x1A,ID_GetCalendarNote },/*method 1*/
+ {N6510_ReplyGetCalendarNotePos, "\x13",0x03,0x32,ID_GetCalendarNotePos },/*method 1*/
+ {N6510_ReplyGetCalendarNotePos, "\x13",0x03,0xF0,ID_GetCalendarNotePos },/*method 1*/
+ {N6510_ReplyGetCalendarInfo, "\x13",0x03,0x3B,ID_GetCalendarNotesInfo},/*method 1*/
+#ifdef DEBUG
+ {N71_65_ReplyGetNextCalendar2, "\x13",0x03,0x3F,ID_GetCalendarNote },
+#endif
+ {N71_65_ReplyAddCalendar2, "\x13",0x03,0x41,ID_SetCalendarNote },/*method 2*/
+ {N6510_ReplyAddCalendar3, "\x13",0x03,0x66,ID_SetCalendarNote },/*method 3*/
+ {N6510_ReplyAddToDo2, "\x13",0x03,0x66,ID_SetToDo },
+ {N6510_ReplyAddNote, "\x13",0x03,0x66,ID_SetNote },
+ {N6510_ReplyGetCalendar3, "\x13",0x03,0x7E,ID_GetCalendarNote },/*method 3*/
+ {N6510_ReplyGetToDo2, "\x13",0x03,0x7E,ID_GetToDo },
+ {N6510_ReplyGetNote, "\x13",0x03,0x7E,ID_GetNote },
+ {N6510_ReplyGetCalendarSettings, "\x13",0x03,0x86,ID_GetCalendarSettings },
+ {N6510_ReplyGetLocale, "\x13",0x03,0x8A,ID_GetLocale },
+ {N6510_ReplyGetCalendarSettings, "\x13",0x03,0x8E,ID_GetCalendarSettings },
+ {N6510_ReplyGetCalendarNotePos, "\x13",0x03,0x96,ID_GetCalendarNotePos },/*method 3*/
+ {N6510_ReplyGetToDoFirstLoc2, "\x13",0x03,0x96,ID_SetToDo },
+ {N6510_ReplyGetNoteFirstLoc, "\x13",0x03,0x96,ID_SetNote },
+ {N6510_ReplyGetCalendarInfo, "\x13",0x03,0x9F,ID_GetCalendarNotesInfo},/*method 3*/
+ {N6510_ReplyGetToDoStatus2, "\x13",0x03,0x9F,ID_GetToDo },
+ {N6510_ReplyGetNoteInfo, "\x13",0x03,0x9F,ID_GetNote },
+
+ {N6510_ReplySaveSMSMessage, "\x14",0x03,0x01,ID_SaveSMSMessage },
+ {N6510_ReplySetPicture, "\x14",0x03,0x01,ID_SetBitmap },
+ {N6510_ReplyGetSMSMessage, "\x14",0x03,0x03,ID_GetSMSMessage },
+ {N6510_ReplyDeleteSMSMessage, "\x14",0x03,0x05,ID_DeleteSMSMessage },
+ {N6510_ReplyDeleteSMSMessage, "\x14",0x03,0x06,ID_DeleteSMSMessage },
+ {N6510_ReplyGetSMSStatus, "\x14",0x03,0x09,ID_GetSMSStatus },
+ {N6510_ReplyGetSMSFolderStatus, "\x14",0x03,0x0d,ID_GetSMSFolderStatus },
+ {N6510_ReplyGetSMSMessage, "\x14",0x03,0x0f,ID_GetSMSMessage },
+ {N6510_ReplyAddSMSFolder, "\x14",0x03,0x11,ID_AddSMSFolder },
+ {N6510_ReplyGetSMSFolders, "\x14",0x03,0x13,ID_GetSMSFolders },
+ {N6510_ReplySaveSMSMessage, "\x14",0x03,0x17,ID_SaveSMSMessage },
+ {N6510_ReplyGetSMSStatus, "\x14",0x03,0x1a,ID_GetSMSStatus },
+ {N6510_ReplyGetSMSStatus, "\x14",0x03,0xf0,ID_GetSMSStatus },
+
+ {DCT4_ReplySetPhoneMode, "\x15",0x03,0x64,ID_Reset },
+ {DCT4_ReplyGetPhoneMode, "\x15",0x03,0x65,ID_Reset },
+ {NoneReply, "\x15",0x03,0x68,ID_Reset },
+
+ {N6510_ReplyGetBatteryCharge, "\x17",0x03,0x0B,ID_GetBatteryCharge },
+ {N6510_IncomingBatteryCharge, "\x17",0x03,0x2c,ID_IncomingFrame },
+
+ {N6510_ReplySetDateTime, "\x19",0x03,0x02,ID_SetDateTime },
+ {N6510_ReplyGetDateTime, "\x19",0x03,0x0B,ID_GetDateTime },
+ {N6510_ReplySetAlarm, "\x19",0x03,0x12,ID_SetAlarm },
+ {N6510_ReplyGetAlarm, "\x19",0x03,0x1A,ID_GetAlarm },
+ {N6510_ReplyGetAlarm, "\x19",0x03,0x20,ID_GetAlarm },
+
+ {DCT4_ReplyGetIMEI, "\x1B",0x03,0x01,ID_GetIMEI },
+ {NOKIA_ReplyGetPhoneString, "\x1B",0x03,0x08,ID_GetHardware },
+ {N6510_ReplyGetPPM, "\x1B",0x03,0x08,ID_GetPPM },
+ {NOKIA_ReplyGetPhoneString, "\x1B",0x03,0x0C,ID_GetProductCode },
+
+ /* 0x1C - vibra */
+
+ {N6510_ReplyGetRingtonesInfo, "\x1f",0x03,0x08,ID_GetRingtonesInfo },
+ {N6510_ReplyDeleteRingtones, "\x1f",0x03,0x11,ID_SetRingtone },
+ {N6510_ReplyGetRingtone, "\x1f",0x03,0x13,ID_GetRingtone },
+ {N6510_ReplySetBinRingtone, "\x1f",0x03,0x0F,ID_SetRingtone },
+
+ /* 0x23 - voice records */
+
+ {N6510_ReplyGetProfile, "\x39",0x03,0x02,ID_GetProfile },
+ {N6510_ReplySetProfile, "\x39",0x03,0x04,ID_SetProfile },
+ {N6510_ReplyGetProfile, "\x39",0x03,0x06,ID_GetProfile },
+
+ {N6510_ReplySetLight, "\x3A",0x03,0x06,ID_SetLight },
+
+ {N6510_ReplyGetFMStation, "\x3E",0x03,0x06,ID_GetFMStation },
+ {N6510_ReplyGetFMStatus, "\x3E",0x03,0x0E,ID_GetFMStation },
+ {N6510_ReplySetFMStation, "\x3E",0x03,0x15,ID_SetFMStation },
+ {N6510_ReplyGetFMStation, "\x3E",0x03,0x16,ID_GetFMStation },
+ {N6510_ReplyGetFMStation, "\x3E",0x03,0xF0,ID_GetFMStation },
+
+ {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 },
+ {N6510_ReplyGetWAPBookmark, "\x3f",0x03,0x07,ID_GetWAPBookmark },
+ {N6510_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 },
+ {N6510_ReplyGetConnectionSettings,"\x3f",0x03,0x11,ID_GetConnectSet },
+ {N6510_ReplyGetConnectionSettings,"\x3f",0x03,0x16,ID_GetConnectSet },
+ {N6510_ReplyGetConnectionSettings,"\x3f",0x03,0x17,ID_GetConnectSet },
+ {N6510_ReplySetConnectionSettings,"\x3f",0x03,0x19,ID_SetConnectSet },
+ {N6510_ReplySetConnectionSettings,"\x3f",0x03,0x1A,ID_SetConnectSet },
+ {N6510_ReplySetConnectionSettings,"\x3f",0x03,0x28,ID_SetConnectSet },
+ {N6510_ReplySetConnectionSettings,"\x3f",0x03,0x2B,ID_SetConnectSet },
+ {N6510_ReplyGetChatSettings, "\x3f",0x03,0x3B,ID_GetChatSettings },
+ {N6510_ReplyGetChatSettings, "\x3f",0x03,0x3C,ID_GetChatSettings },
+ {N6510_ReplyGetConnectionSettings,"\x3f",0x03,0xf0,ID_GetConnectSet },
+
+ {N6510_ReplyGetOriginalIMEI, "\x42",0x07,0x00,ID_GetOriginalIMEI },
+ {N6510_ReplyGetManufactureMonth, "\x42",0x07,0x00,ID_GetManufactureMonth },
+ {N6510_ReplyGetOriginalIMEI, "\x42",0x07,0x01,ID_GetOriginalIMEI },
+ {N6510_ReplyGetManufactureMonth, "\x42",0x07,0x02,ID_GetManufactureMonth },
+
+ {N6510_ReplySetOperatorLogo, "\x43",0x03,0x08,ID_SetBitmap },
+ {N6510_ReplyGetGPRSAccessPoint, "\x43",0x03,0x06,ID_GetGPRSPoint },
+ {N6510_ReplySetGPRSAccessPoint1, "\x43",0x03,0x06,ID_SetGPRSPoint },
+ {N6510_ReplyGetSyncMLSettings, "\x43",0x03,0x06,ID_GetSyncMLSettings },
+ {N6510_ReplyGetSyncMLName, "\x43",0x03,0x06,ID_GetSyncMLName },
+ {NoneReply, "\x43",0x03,0x08,ID_SetGPRSPoint },
+
+ /* 0x4A - voice records */
+
+ /* 0x53 - simlock */
+
+ {N6510_ReplyAddToDo1, "\x55",0x03,0x02,ID_SetToDo },
+ {N6510_ReplyGetToDo1, "\x55",0x03,0x04,ID_GetToDo },
+ {N6510_ReplyGetToDoFirstLoc1, "\x55",0x03,0x10,ID_SetToDo },
+ {N6510_ReplyDeleteAllToDo1, "\x55",0x03,0x12,ID_DeleteAllToDo },
+ {N6510_ReplyGetToDoStatus1, "\x55",0x03,0x16,ID_GetToDo },
+
+ {N6510_ReplyAddFileHeader1, "\x6D",0x03,0x03,ID_AddFile },
+ {N6510_ReplyAddFolder1, "\x6D",0x03,0x05,ID_AddFolder },
+ {N6510_ReplyGetFilePart12, "\x6D",0x03,0x0F,ID_GetFile },/* filesystem1&2 */
+ {N6510_ReplyAddFileHeader1, "\x6D",0x03,0x13,ID_AddFile },
+ {N6510_ReplyGetFileFolderInfo1, "\x6D",0x03,0x15,ID_GetFileInfo },
+ {NoneReply, "\x6D",0x03,0x19,ID_SetAttrib },
+ {N6510_ReplyDeleteFileFolder1, "\x6D",0x03,0x1F,ID_DeleteFile },
+ {N6510_ReplyGetFileSystemStatus1, "\x6D",0x03,0x23,ID_FileSystemStatus },
+ {N6510_ReplyGetFileFolderInfo1, "\x6D",0x03,0x2F,ID_GetFileInfo },
+ {N6510_ReplyGetFileSystemStatus1, "\x6D",0x03,0x2F,ID_FileSystemStatus },
+ {N6510_ReplyGetFileFolderInfo1, "\x6D",0x03,0x33,ID_GetFileInfo },
+ {N6510_ReplyGetFileFolderInfo1, "\x6D",0x03,0xF0,ID_GetFileInfo },
+ {N6510_ReplyAddFilePart1, "\x6D",0x03,0x41,ID_AddFile },
+ {N6510_ReplyGetFileCRC12, "\x6D",0x03,0x43,ID_GetCRC },
+ {NoneReply, "\x6D",0x03,0x59,ID_AddFile },/* filesystem2 */
+ {N6510_ReplyGetFilePart12, "\x6D",0x03,0x5F,ID_GetFile },/* filesystem2 */
+ {N6510_ReplyDeleteFile2, "\x6D",0x03,0x63,ID_DeleteFile },/* filesystem2 */
+ {N6510_ReplyAddFolder2, "\x6D",0x03,0x65,ID_AddFolder },/* filesystem2 */
+ {N6510_ReplyGetFileCRC12, "\x6D",0x03,0x67,ID_GetCRC },/* filesystem2 */
+ {N6510_ReplyGetFileFolderInfo2, "\x6D",0x03,0x69,ID_IncomingFrame },/* filesystem2 */
+ {N6510_ReplyDeleteFolder2, "\x6D",0x03,0x6B,ID_DeleteFolder },/* filesystem2 */
+ {N6510_ReplyGetFileFolderInfo2, "\x6D",0x03,0x6D,ID_GetFileInfo },/* filesystem2 */
+ {N6510_ReplySetAttrib2, "\x6D",0x03,0x6F,ID_SetAttrib },/* filesystem2 */
+ {N6510_ReplyOpenFile2, "\x6D",0x03,0x73,ID_OpenFile },/* filesystem2 */
+ {NoneReply, "\x6D",0x03,0x75,ID_CloseFile },/* filesystem2 */
+ {N6510_ReplySetFileDate2, "\x6D",0x03,0x87,ID_AddFile },/* filesystem2 */
+
+ {N6510_ReplyStartupNoteLogo, "\x7A",0x04,0x01,ID_GetBitmap },
+ {N6510_ReplyStartupNoteLogo, "\x7A",0x04,0x01,ID_SetBitmap },
+ {N6510_ReplyStartupNoteLogo, "\x7A",0x04,0x0F,ID_GetBitmap },
+ {N6510_ReplyStartupNoteLogo, "\x7A",0x04,0x0F,ID_SetBitmap },
+ {N6510_ReplyStartupNoteLogo, "\x7A",0x04,0x10,ID_GetBitmap },
+ {N6510_ReplyStartupNoteLogo, "\x7A",0x04,0x10,ID_SetBitmap },
+ {N6510_ReplyStartupNoteLogo, "\x7A",0x04,0x25,ID_SetBitmap },
+
+ {DCT3DCT4_ReplyGetModelFirmware, "\xD2",0x02,0x00,ID_GetModel },
+ {DCT3DCT4_ReplyGetModelFirmware, "\xD2",0x02,0x00,ID_GetFirmware },
+
+ /* 0xD7 - Bluetooth */
+
+ {N6510_ReplyGetRingtoneID, "\xDB",0x03,0x02,ID_SetRingtone },
+
+ {DCT4_ReplyGetScreenDump, "\x0E",0x00,0x00,ID_Screenshot },
+ {DCT4_ReplyGetScreenInfo, "\x0E",0x00,0x00,ID_GetScreenSize },
+
+ {NULL, "\x00",0x00,0x00,ID_None }
+};
+
+GSM_Phone_Functions N6510Phone = {
+ "1100|1100a|1100b|1112|1200|1209|1600|1650|1680|2600|2610|2630|2650|2660|2680|2760|3100|3100b|3105|3108|3109c|3200|3200a|3205|3220|3300|3510|3510i|3530|3589i|3590|3595|5000|5100|5140|5140i|5200|5220|5300|5310|6020|6020b|6021|6030|6060|6070|6085|6086|6100|6101|6103|6111|6125|6131|6151|6170|6200|6220|6220c|6225|6230|6230i|6233|6234|6270|6275i|6280|6300|6303c|6310|6310i|6340i|6385|6500c|6500s|6510|6600|6610|6610i|6800|6810|6820|6822|7200|7210|7210s|7230|7250|7250i|7260|7270|7360|7370|7500|7600|7900|8310|8390|8800|8910|8910i",
+ N6510ReplyFunctions,
+ NOTSUPPORTED, /* Install */
+ N6510_Initialise,
+ N6510_Terminate,
+ GSM_DispatchMessage,
+ N6510_ShowStartInfo,
+ NOKIA_GetManufacturer,
+ DCT3DCT4_GetModel,
+ DCT3DCT4_GetFirmware,
+ DCT4_GetIMEI,
+ N6510_GetOriginalIMEI,
+ N6510_GetManufactureMonth,
+ DCT4_GetProductCode,
+ DCT4_GetHardware,
+ N6510_GetPPM,
+ NOTSUPPORTED, /* GetSIMIMSI */
+ N6510_GetDateTime,
+ N6510_SetDateTime,
+ N6510_GetAlarm,
+ N6510_SetAlarm,
+ N6510_GetLocale,
+ NOTSUPPORTED, /* SetLocale */
+ N6510_PressKey,
+ DCT4_Reset,
+ NOTIMPLEMENTED, /* ResetPhoneSettings */
+ N6510_EnterSecurityCode,
+ N6510_GetSecurityStatus,
+ NOTSUPPORTED, /* GetDisplayStatus */
+ NOTIMPLEMENTED, /* SetAutoNetworkLogin */
+ N6510_GetBatteryCharge,
+ N6510_GetSignalQuality,
+ N6510_GetNetworkInfo,
+ NOTSUPPORTED, /* GetCategory */
+ NOTSUPPORTED, /* AddCategory */
+ NOTSUPPORTED, /* GetCategoryStatus */
+ N6510_GetMemoryStatus,
+ N6510_GetMemory,
+ NOTIMPLEMENTED, /* GetNextMemory */
+ N6510_SetMemory,
+ N6510_AddMemory,
+ N6510_DeleteMemory,
+ NOTIMPLEMENTED, /* DeleteAllMemory */
+ N6510_GetSpeedDial,
+ NOTIMPLEMENTED, /* SetSpeedDial */
+ N6510_GetSMSC,
+ N6510_SetSMSC,
+ N6510_GetSMSStatus,
+ N6510_GetSMSMessage,
+ N6510_GetNextSMSMessage,
+ N6510_SetSMS,
+ N6510_AddSMS,
+ N6510_DeleteSMSMessage,
+ N6510_SendSMSMessage,
+ NOTSUPPORTED, /* SendSavedSMS */
+ NOTSUPPORTED, /* SetFastSMSSending */
+ NOKIA_SetIncomingSMS,
+ NOTIMPLEMENTED, /* SetIncomingCB */
+ N6510_GetSMSFolders,
+ N6510_AddSMSFolder,
+ NOTIMPLEMENTED, /* DeleteSMSFolder */
+ N6510_DialVoice,
+ NOTIMPLEMENTED, /* DialService */
+ N6510_AnswerCall,
+ N6510_CancelCall,
+ NOTIMPLEMENTED, /* HoldCall */
+ NOTIMPLEMENTED, /* UnholdCall */
+ NOTIMPLEMENTED, /* ConferenceCall */
+ NOTIMPLEMENTED, /* SplitCall */
+ NOTIMPLEMENTED, /* TransferCall */
+ NOTIMPLEMENTED, /* SwitchCall */
+ DCT3DCT4_GetCallDivert,
+ DCT3DCT4_SetCallDivert,
+ DCT3DCT4_CancelAllDiverts,
+ NOKIA_SetIncomingCall,
+ NOKIA_SetIncomingUSSD,
+ DCT3DCT4_SendDTMF,
+ N6510_GetRingtone,
+ N6510_SetRingtone,
+ N6510_GetRingtonesInfo,
+ N6510_DeleteUserRingtones,
+ N6510_PlayTone,
+ N6510_GetWAPBookmark,
+ N6510_SetWAPBookmark,
+ N6510_DeleteWAPBookmark,
+ N6510_GetWAPSettings,
+ N6510_SetWAPSettings,
+ N6510_GetSyncMLSettings,
+ NOTSUPPORTED, /* SetSyncMLSettings */
+ N6510_GetChatSettings,
+ NOTSUPPORTED, /* SetChatSettings */
+ N6510_GetMMSSettings,
+ N6510_SetMMSSettings,
+ N6510_GetMMSFolders,
+ N6510_GetNextMMSFileInfo,
+ N6510_GetBitmap,
+ N6510_SetBitmap,
+ N6510_GetToDoStatus,
+ NOTIMPLEMENTED, /* GetToDo */
+ N6510_GetNextToDo,
+ NOTIMPLEMENTED, /* SetToDo */
+ N6510_AddToDo,
+ N6510_DeleteToDo2,
+ N6510_DeleteAllToDo1,
+ N6510_GetCalendarStatus,
+ NOTIMPLEMENTED, /* GetCalendar */
+ N6510_GetNextCalendar,
+ NOTIMPLEMENTED, /* SetCalendar */
+ N6510_AddCalendar,
+ N71_65_DelCalendar,
+ NOTIMPLEMENTED, /* DeleteAllCalendar */
+ N6510_GetCalendarSettings,
+ NOTSUPPORTED, /* SetCalendarSettings */
+ N6510_GetNoteStatus,
+ NOTIMPLEMENTED, /* GetNote */
+ N6510_GetNextNote,
+ NOTIMPLEMENTED, /* SetNote */
+ N6510_AddNote,
+ N6510_DeleteNote,
+ NOTSUPPORTED, /* DeleteAllNotes */
+ N6510_GetProfile,
+ N6510_SetProfile,
+ N6510_GetFMStation,
+ N6510_SetFMStation,
+ N6510_ClearFMStations,
+ N6510_GetNextFileFolder,
+ N6510_GetFolderListing,
+ N6510_GetNextRootFolder,
+ N6510_SetFileAttributes,
+ N6510_GetFilePart,
+ N6510_AddFilePart,
+ NOTSUPPORTED, /* SendFilePart */
+ N6510_GetFileSystemStatus,
+ N6510_DeleteFile,
+ N6510_AddFolder,
+ N6510_DeleteFolder,
+ N6510_GetGPRSAccessPoint,
+ N6510_SetGPRSAccessPoint,
+ DCT4_Screenshot,
+ NOTSUPPORTED, /* SetPower */
+ NOTSUPPORTED, /* PostConnect */
+ NONEFUNCTION /* PreAPICall */
+};
+
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */
diff --git a/libgammu/phone/nokia/dct4s40/6510/n6510.h b/libgammu/phone/nokia/dct4s40/6510/n6510.h
new file mode 100644
index 0000000..32fadbb
--- /dev/null
+++ b/libgammu/phone/nokia/dct4s40/6510/n6510.h
@@ -0,0 +1,127 @@
+/* (c) 2002-2005 by Marcin Wiacek */
+
+#ifndef n6510_h
+#define n6510_h
+
+#include "../../ncommon.h"
+
+typedef enum {
+ N6510_MMS_SETTINGS = 0x01,
+ N6510_CHAT_SETTINGS,
+
+ N6510_WAP_SETTINGS,
+ N6510_SYNCML_SETTINGS
+} N6510_Connection_Settings;
+
+typedef enum {
+ N6510_LIGHT_DISPLAY = 0x01,
+ N6510_LIGHT_KEYPAD = 0x03,
+ N6510_LIGHT_TORCH = 0x10
+} N6510_PHONE_LIGHTS;
+
+typedef struct {
+ int LastCalendarYear;
+ int LastCalendarPos;
+ GSM_NOKIACalToDoLocations LastCalendar;
+ int FirstCalendarPos;
+ unsigned char CalendarIcons[10];
+ GSM_CalendarNoteType CalendarIconsTypes[10];
+ int CalendarIconsNum;
+
+ GSM_NOKIASMSFolder LastSMSFolder;
+ GSM_SMSFolders LastSMSFolders;
+ GSM_File SMSFile;
+ GSM_Error SMSFileError;
+ int SMSFileFolder;
+
+ GSM_NOKIACalToDoLocations LastToDo;
+
+ GSM_NOKIACalToDoLocations LastNote;
+
+ unsigned char RingtoneID; /* When set with preview */
+
+ GSM_File *FilesCache; //[GSM_PHONE_MAXSMSINFOLDER];
+ int FilesLocationsUsed;
+ int FilesLocationsAvail;
+ int FileToken;
+ int ParentID;
+ int FileCheckSum;
+ gboolean FilesEnd;
+ gboolean UseFs1;
+ GSM_Error filesystem2error;
+
+ unsigned char FMStatus[4000];
+ int FMStatusLength;
+
+ unsigned char GPRSPoints[4000];
+ int GPRSPointsLength;
+
+ int BearerNumber;
+
+ unsigned char PhoneMode;
+
+ char MMSFoldersID2[10][80];
+ GSM_File MMSFile;
+ int MMSFolderNum;
+ GSM_Error MMSFolderError;
+
+ /**
+ * Last location we used for adding memory entry.
+ */
+ int LastFreeMemoryLocation;
+ /**
+ * Last type of memory used for LastFreeMemoryLocation.
+ */
+ GSM_MemoryType LastFreeMemoryType;
+ /**
+ * Size of memory when starting last free memory lookup.
+ */
+ int LastFreeMemorySize;
+ /**
+ * Communication timeout. This needs to be higher for unreliable
+ * links as IrDA.
+ */
+ int Timeout;
+ int ScreenWidth;
+ int ScreenHeight;
+} GSM_Phone_N6510Data;
+
+void N6510_EncodeFMFrequency(double freq, unsigned char *buff);
+void N6510_DecodeFMFrequency(double *freq, unsigned char *buff);
+
+#ifndef GSM_USED_MBUS2
+# define GSM_USED_MBUS2
+#endif
+#ifndef GSM_USED_FBUS2
+# define GSM_USED_FBUS2
+#endif
+#ifndef GSM_USED_FBUS2DLR3
+# define GSM_USED_FBUS2DLR3
+#endif
+#ifndef GSM_USED_DKU2PHONET
+# define GSM_USED_DKU2PHONET
+#endif
+#ifndef GSM_USED_DKU2AT
+# define GSM_USED_DKU2AT
+#endif
+#ifndef GSM_USED_DKU5FBUS2
+# define GSM_USED_DKU5FBUS2
+#endif
+#ifndef GSM_USED_PHONETBLUE
+# define GSM_USED_PHONETBLUE
+#endif
+#ifndef GSM_USED_IRDAPHONET
+# define GSM_USED_IRDAPHONET
+#endif
+#ifndef GSM_USED_BLUEPHONET
+# define GSM_USED_BLUEPHONET
+#endif
+#ifndef GSM_USED_FBUS2PL2303
+# define GSM_USED_FBUS2PL2303
+#endif
+
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */