1 files changed, 110 insertions, 0 deletions

diff --git a/gammu/emb/common/protocol/symbian/mrouter.c b/gammu/emb/common/protocol/symbian/mrouter.c
new file mode 100644
index 0000000..2ca7af1
--- a/dev/null
+++ b/gammu/emb/common/protocol/symbian/mrouter.c
@@ -0,0 +1,110 @@
+/* (c) 2003 by Marcin Wiacek */
+
+#include "../../gsmstate.h"
+
+#if defined(GSM_ENABLE_MROUTERBLUE)
+
+#include <stdio.h>
+#include <string.h>
+
+#include "../../gsmcomon.h"
+#include "mrouter.h"
+
+static GSM_Error MROUTER_WriteMessage (GSM_StateMachine *s, unsigned char *buffer,
+                                    int length, unsigned char type)
+{
+                unsigned char*out_buffer; 
+                int     current=0,sent;
+        
+        out_buffer = (unsigned char *)malloc(length+1);
+
+        memcpy(out_buffer,buffer,length);
+        out_buffer[length]=0x7E;
+
+        GSM_DumpMessageLevel2(s, out_buffer, length, type);
+        GSM_DumpMessageLevel3(s, out_buffer, length, type);
+
+        /* Send it out... */
+        sent = s->Device.Functions->WriteDevice(s,out_buffer,length+1);
+
+        free(out_buffer);
+
+        if (sent!=current) return ERR_DEVICEWRITEERROR;
+        return ERR_NONE;
+}
+
+static GSM_Error MROUTER_StateMachine(GSM_StateMachine *s, unsigned char rx_char)
+{
+                GSM_Phone_Functions     *Phone= s->Phone.Functions;
+                GSM_Protocol_MROUTERData        *d= &s->Protocol.Data.MROUTER;
+
+        switch (d->MsgRXState) {
+        case RX_Sync:
+                if (rx_char == 0x7E) {
+                        d->MsgRXState = RX_GetMessage;
+                        d->Msg.Count = 0;
+                        d->Msg.Length = 0;
+                } else smprintf(s,"Sync error: %02x\n",rx_char);
+                break;
+        case RX_GetMessage:
+                if (rx_char == 0x7E) {
+                                s->Phone.Data.RequestMsg= &d->Msg;
+                                s->Phone.Data.DispatchError= Phone->DispatchMessage(s);
+                        d->Msg.Count = 0;
+                        d->Msg.Length = 0;
+                } else {
+                                d->Msg.BufferUsed = d->Msg.Length+1;
+                                d->Msg.Buffer   = (unsigned char *)realloc(d->Msg.Buffer,d->Msg.BufferUsed);
+
+                        d->Msg.Buffer[d->Msg.Count] = rx_char;
+                        d->Msg.Count++;
+                        d->Msg.Length++;
+                }
+                break;
+        }
+
+        return ERR_NONE;
+}
+
+static GSM_Error MROUTER_Initialise(GSM_StateMachine *s)
+{
+        GSM_Protocol_MROUTERData *d = &s->Protocol.Data.MROUTER;
+GSM_Error error;
+
+                d->Msg.BufferUsed= 0;
+                d->Msg.Buffer   = NULL;
+                d->Msg.Length   = 0;
+
+                d->MsgRXState   = RX_Sync;
+
+        //error=s->Device.Functions->DeviceSetDtrRts(s,false,false);
+        //    if (error!=ERR_NONE) return error; 
+
+        error=s->Device.Functions->DeviceSetSpeed(s,115200);
+            if (error!=ERR_NONE) return error; 
+
+
+        //error=s->Device.Functions->DeviceSetSpeed(s,115200);
+        //    if (error!=ERR_NONE) return error; 
+
+        return ERR_NONE;
+}
+
+static GSM_Error MROUTER_Terminate(GSM_StateMachine *s)
+{
+        free(s->Protocol.Data.MROUTER.Msg.Buffer);
+        return ERR_NONE;
+}
+
+GSM_Protocol_Functions MROUTERProtocol = {
+        MROUTER_WriteMessage,
+        MROUTER_StateMachine,
+        MROUTER_Initialise,
+        MROUTER_Terminate
+};
+
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */