X-Git-Url: https://git.jankratochvil.net/?p=gnokii.git;a=blobdiff_plain;f=common%2Fnewmodules%2Fn6110.c;h=a4599617afb7f741ca170d2edf309bbdf681f6f0;hp=80e0115eced3550967537c5e321a2b2c73c6470f;hb=82bcbc2300f764bcb3551b152a0a961f4fef5e66;hpb=a2613480a5a1d2e6a1314841f43ae53e85f05f8b diff --git a/common/newmodules/n6110.c b/common/newmodules/n6110.c index 80e0115..a459961 100644 --- a/common/newmodules/n6110.c +++ b/common/newmodules/n6110.c @@ -190,7 +190,7 @@ GSM_Functions N6110_Functions = { GSM_Information N6110_Information = { "3210|3310|3330|5110|5130|5190|6110|6130|6150|6190|8210|8850", /* Supported models in FBUS */ - "3210|3310|3330|5110|5130|5190|6110|6130|6150|6190|8210|8850", + "3210|3310|3330|5110|5130|5190|6110|6130|6150|6190|8210|8850|9210", /* Supported models in MBUS */ "6110|6130|6150|8210|8850", /* Supported models in FBUS over infrared */ @@ -201,7 +201,7 @@ GSM_Information N6110_Information = { "8210|8850", /* infrared sockets */ "6110|6130|6150|8210|8850", - /* Supported models in FBUS over infrared with Tekram device */ + /* Supported models in FBUS over infrared with Tekram device */ "", 4, /* Max RF Level */ 0, /* Min RF Level */ GRF_Arbitrary, /* RF level units */ @@ -596,6 +596,14 @@ static GSM_Error N6110_Authentication() 0x00, 0x00, 0x00, 0x00}; + unsigned char req3_55[] = { N6110_FRAME_HEADER, 0x42,0x05,0x01, + 0x07,0xa2,0x88,0x81,0x21,0x55,0x63,0xa8,0x00,0x00, + 0x07,0xa3,0xb8,0x81,0x20,0x15,0x63,0x80 }; + unsigned char req3[] = { N6110_FRAME_HEADER, 0x42,0x05,0x01, + 0x07,0xa2,0x88,0x81,0x21,0x15,0x63,0xa8,0x00,0x00, + 0x07,0xa3,0xb8,0x81,0x20,0x15,0x63,0x80 }; + unsigned char unknown_05[] = {N6110_FRAME_HEADER, 0x05}; + #ifdef DEBUG fprintf(stdout,_("Making authentication!\n")); #endif @@ -604,15 +612,23 @@ static GSM_Error N6110_Authentication() usleep(100); Protocol->SendMessage(5, 0x02, connect2); usleep(100); Protocol->SendMessage(7, 0x02, connect3); + usleep(100); Protocol->SendMessage(sizeof(req3_55), 0x01, req3_55); /* Lace */ + CurrentMagicError = GE_BUSY; usleep(100); Protocol->SendMessage(4, 0x64, connect4); + + usleep(100); Protocol->SendMessage(sizeof(req3_55), 0x01, req3_55); /* Lace */ + usleep(100); Protocol->SendMessage(sizeof(req3), 0x01, req3); /* Lace */ + if (NULL_WaitUntil(50,&CurrentMagicError)!=GE_NONE) return GE_TIMEOUT; N6110_GetNokiaAuth(Current_IMEI, MagicBytes, magic_connect+4); Protocol->SendMessage(45, 0x64, magic_connect); + usleep(100); Protocol->SendMessage(4, 0x04, unknown_05); /* Lace */ + #ifdef DEBUG fprintf(stdout,_("End of authentication!\n")); #endif @@ -810,34 +826,35 @@ void N6110_ReplyCallDivert(u16 MessageLength, u8 *MessageBuffer, u8 MessageType) fprintf(stdout, _(" Status : deactivated\n")); } #endif /* DEBUG */ - - switch (MessageBuffer[6]) { - case 0x43: CurrentCallDivert->DType=GSM_CDV_Busy;break; - case 0x3d: CurrentCallDivert->DType=GSM_CDV_NoAnswer;break; - case 0x3e: CurrentCallDivert->DType=GSM_CDV_OutOfReach;break; - case 0x15: CurrentCallDivert->DType=GSM_CDV_AllTypes;break; //? - case 0x02: CurrentCallDivert->DType=GSM_CDV_AllTypes;break; //? - } - if (MessageBuffer[6]==0x02) //? - CurrentCallDivert->CType=GSM_CDV_AllCalls; - else { - switch (MessageBuffer[8]) { - case 0x0b: CurrentCallDivert->CType=GSM_CDV_VoiceCalls;break; - case 0x0d: CurrentCallDivert->CType=GSM_CDV_FaxCalls; break; - case 0x19: CurrentCallDivert->CType=GSM_CDV_DataCalls; break; + if (CurrentCallDivert!=NULL) { + switch (MessageBuffer[6]) { + case 0x43: CurrentCallDivert->DType=GSM_CDV_Busy;break; + case 0x3d: CurrentCallDivert->DType=GSM_CDV_NoAnswer;break; + case 0x3e: CurrentCallDivert->DType=GSM_CDV_OutOfReach;break; + case 0x15: CurrentCallDivert->DType=GSM_CDV_AllTypes;break; //? + case 0x02: CurrentCallDivert->DType=GSM_CDV_AllTypes;break; //? } - } - if (MessageBuffer[10]==0x01) { - CurrentCallDivert->Enabled=true; - CurrentCallDivert->Timeout=MessageBuffer[45]; - strcpy(CurrentCallDivert->Number,GSM_UnpackSemiOctetNumber(MessageBuffer+12,true)); - } else { - CurrentCallDivert->Enabled=false; - } + if (MessageBuffer[6]==0x02) //? + CurrentCallDivert->CType=GSM_CDV_AllCalls; + else { + switch (MessageBuffer[8]) { + case 0x0b: CurrentCallDivert->CType=GSM_CDV_VoiceCalls;break; + case 0x0d: CurrentCallDivert->CType=GSM_CDV_FaxCalls; break; + case 0x19: CurrentCallDivert->CType=GSM_CDV_DataCalls; break; + } + } - CurrentCallDivertError=GE_NONE; + if (MessageBuffer[10]==0x01) { + CurrentCallDivert->Enabled=true; + CurrentCallDivert->Timeout=MessageBuffer[45]; + strcpy(CurrentCallDivert->Number,GSM_UnpackSemiOctetNumber(MessageBuffer+12,true)); + } else { + CurrentCallDivert->Enabled=false; + } + CurrentCallDivertError=GE_NONE; + } break; case 0x03: @@ -2564,9 +2581,11 @@ GSM_Error N6110_DialData(char *Number, char type, void (* callpassup)(char c)) 0x02,0x01,0x05,0x81,0x01,0x00,0x00,0x01,0x02,0x0a, 0x07,0xa1,0x88,0x89,0x21,0x15,0x63,0xa0,0x00,0x06, 0x88,0x90,0x21,0x48,0x40,0xbb }; +#if 0 unsigned char req2[] = { N6110_FRAME_HEADER, 0x42,0x05,0x01, 0x07,0xa2,0xc8,0x81,0x21,0x15,0x63,0xa8,0x00,0x00, 0x07,0xa3,0xb8,0x81,0x20,0x15,0x63,0x80,0x01,0x60 }; +#endif unsigned char req3[] = { N6110_FRAME_HEADER, 0x42,0x05,0x01, 0x07,0xa2,0x88,0x81,0x21,0x15,0x63,0xa8,0x00,0x00, 0x07,0xa3,0xb8,0x81,0x20,0x15,0x63,0x80 }; @@ -2582,6 +2601,8 @@ GSM_Error N6110_DialData(char *Number, char type, void (* callpassup)(char c)) switch (type) { case 0: + usleep(100); Protocol->SendMessage(sizeof(req3), 0x01, req3); /* Lace */ + usleep(100); req_end = req_end0; size = sizeof(req_end0); break; @@ -2610,8 +2631,14 @@ GSM_Error N6110_DialData(char *Number, char type, void (* callpassup)(char c)) memcpy(req + 5 + strlen(Number), req_end, size); Protocol->SendMessage(5 + size + strlen(Number), 0x01, req); - usleep(1000000); - if (type != 1) Protocol->SendMessage(26, 0x01, req2); + usleep(1000000); + +#if 0 + if (type != 1) { + Protocol->SendMessage(26, 0x01, req2); + usleep(1000000); + } +#endif return (GE_NONE); } @@ -3270,7 +3297,8 @@ static void N6110_ReplyGetMemoryLocation(u16 MessageLength, u8 *MessageBuffer, u while (N6110_GetModel(model) != GE_NONE) sleep(1); - if (GetModelFeature (FN_PHONEBOOK)==F_PBK33) {//pbk with Unicode + if (GetModelFeature (FN_PHONEBOOK)==F_PBK33SIM || + GetModelFeature (FN_PHONEBOOK)==F_PBK33INT) {//pbk with Unicode #ifndef UCLINUX DecodeUnicode (CurrentPhonebookEntry->Name, MessageBuffer+6, count/2); CurrentPhonebookEntry->Name[count/2] = 0x00; @@ -3287,7 +3315,8 @@ static void N6110_ReplyGetMemoryLocation(u16 MessageLength, u8 *MessageBuffer, u for (tmp=0; tmp Name[tmp/2]='~'; //enables/disables blinking if (tmp%2!=0 && MessageBuffer[6+tmp]==0) CurrentPhonebookEntry->Name[tmp/2]='`'; //hides rest ot contents @@ -3444,7 +3473,8 @@ GSM_Error N6110_WritePhonebookLocation(GSM_PhonebookEntry *entry) current=7; - if (GetModelFeature (FN_PHONEBOOK)==F_PBK33) { + if (GetModelFeature (FN_PHONEBOOK)==F_PBK33INT || + GetModelFeature (FN_PHONEBOOK)==F_PBK33SIM) { #ifndef UCLINUX req[6] = strlen(entry->Name)*2; @@ -3821,14 +3851,10 @@ void N6110_ReplyGetSMSMessage(u16 MessageLength, u8 *MessageBuffer, u8 MessageTy fprintf(stdout, _("Message: SMS reading failed\n")); switch (MessageBuffer[4]) { - case 0x02: - fprintf(stdout, _(" Invalid location!\n"));break; - case 0x07: - fprintf(stdout, _(" Empty SMS location.\n"));break; - case 0x0c: - fprintf(stdout, _(" No access to memory (no PIN on card ?)\n"));break; - default: - fprintf(stdout, _(" Error code %i - please report it \n"),MessageBuffer[4]);break; + case 0x02:fprintf(stdout, _(" Invalid location!\n"));break; + case 0x07:fprintf(stdout, _(" Empty SMS location.\n"));break; + case 0x0c:fprintf(stdout, _(" No access to memory (no PIN on card ?)\n"));break; + default :fprintf(stdout, _(" Error code %i - please report it \n"),MessageBuffer[4]);break; } #endif /* DEBUG */ @@ -3915,8 +3941,7 @@ GSM_Error GSM_EncodeNokiaSMSFrame(GSM_SMSMessage *SMS, unsigned char *req, int * switch (PDU) { case SMS_Submit: offset=5; - for (i=0;i<((ETSI.Number[0]+1)/2+1)+1;i++) - req[i+12+offset]=ETSI.Number[i]; + for (i=0;i<((ETSI.Number[0]+1)/2+1)+1;i++) req[i+12+offset]=ETSI.Number[i]; req[10+offset]=ETSI.TPDCS; req[11+offset]=ETSI.TPUDL; req[24+offset]=ETSI.TPVP; @@ -3926,21 +3951,17 @@ GSM_Error GSM_EncodeNokiaSMSFrame(GSM_SMSMessage *SMS, unsigned char *req, int * // fprintf(stdout,_(" TP-DCS: %02x\n"),ETSI.TPDCS); #endif // req[]=ETSI.TPPID; - for(i=0;i<*length;i++) - req[i+31+offset]=ETSI.MessageText[i]; + for(i=0;i<*length;i++) req[i+31+offset]=ETSI.MessageText[i]; break; case SMS_Deliver: offset=4; - for (i=0;i<((ETSI.Number[0]+1)/2+1)+1;i++) - req[i+12+offset]=ETSI.Number[i]; + for (i=0;i<((ETSI.Number[0]+1)/2+1)+1;i++) req[i+12+offset]=ETSI.Number[i]; req[10+offset]=ETSI.TPDCS; req[11+offset]=ETSI.TPUDL; // req[]=ETSI.TPPID; - for(i=0;i<*length;i++) - req[i+31+offset]=ETSI.MessageText[i]; - for (i=0;i<7;i++) - req[24+offset+i]=ETSI.DeliveryDateTime[i]; + for(i=0;i<*length;i++) req[i+31+offset]=ETSI.MessageText[i]; + for (i=0;i<7;i++) req[24+offset+i]=ETSI.DeliveryDateTime[i]; break; default: break; @@ -4959,7 +4980,7 @@ static void N6110_Dispatch0x03Message(u16 MessageLength, u8 *MessageBuffer, u8 M CurrentGetBitmap->width=MessageBuffer[count++]; CurrentGetBitmap->height=MessageBuffer[count++]; count++; - tmp=CurrentGetBitmap->height*CurrentGetBitmap->width/8; + tmp=GSM_GetBitmapSize(CurrentGetBitmap); if (CurrentGetBitmap->size>tmp) CurrentGetBitmap->size=tmp; memcpy(CurrentGetBitmap->bitmap,MessageBuffer+count,CurrentGetBitmap->size); CurrentGetBitmapError=GE_NONE; @@ -5043,10 +5064,11 @@ static void N6110_Dispatch0x05Message(u16 MessageLength, u8 *MessageBuffer, u8 M if (CurrentGetBitmap->type==GSM_StartupLogo) { CurrentGetBitmap->height=MessageBuffer[count++]; CurrentGetBitmap->width=MessageBuffer[count++]; - CurrentGetBitmap->size=CurrentGetBitmap->height*CurrentGetBitmap->width/8; + CurrentGetBitmap->size=GSM_GetBitmapSize(CurrentGetBitmap); length=CurrentGetBitmap->size; memcpy(CurrentGetBitmap->bitmap,MessageBuffer+count,length); } else { + //bitmap size length=MessageBuffer[count++]; length=length*MessageBuffer[count++]/8; } @@ -5161,7 +5183,7 @@ static void N6110_Dispatch0x05Message(u16 MessageLength, u8 *MessageBuffer, u8 M CurrentGetBitmap->width=MessageBuffer[count++]; CurrentGetBitmap->height=MessageBuffer[count++]; count++; - tmp=CurrentGetBitmap->height*CurrentGetBitmap->width/8; + tmp=GSM_GetBitmapSize(CurrentGetBitmap); if (CurrentGetBitmap->size>tmp) CurrentGetBitmap->size=tmp; memcpy(CurrentGetBitmap->bitmap,MessageBuffer+count,CurrentGetBitmap->size); CurrentGetBitmapError=GE_NONE; @@ -5411,7 +5433,7 @@ static void N6110_Dispatch0x47Message(u16 MessageLength, u8 *MessageBuffer, u8 M CurrentGetBitmap->width=MessageBuffer[count+1]; CurrentGetBitmap->height=MessageBuffer[count+2]; - CurrentGetBitmap->size=CurrentGetBitmap->height*CurrentGetBitmap->width/8; + CurrentGetBitmap->size=GSM_GetBitmapSize(CurrentGetBitmap); memcpy(CurrentGetBitmap->bitmap,MessageBuffer+count+4,CurrentGetBitmap->size);