summaryrefslogtreecommitdiffabout
path: root/gammu/emb/common/protocol/obex
Side-by-side diff
Diffstat (limited to 'gammu/emb/common/protocol/obex') (more/less context) (ignore whitespace changes)
-rw-r--r--gammu/emb/common/protocol/obex/obex.c120
-rw-r--r--gammu/emb/common/protocol/obex/obex.h33
2 files changed, 153 insertions, 0 deletions
diff --git a/gammu/emb/common/protocol/obex/obex.c b/gammu/emb/common/protocol/obex/obex.c
new file mode 100644
index 0000000..942c084
--- a/dev/null
+++ b/gammu/emb/common/protocol/obex/obex.c
@@ -0,0 +1,120 @@
+/* (c) 2003 by Marcin Wiacek */
+/* www.irda.org OBEX specs 1.3 */
+
+#include "../../gsmstate.h"
+
+#include <stdio.h>
+#include <string.h>
+
+#if defined(GSM_ENABLE_BLUEOBEX) || defined(GSM_ENABLE_IRDAOBEX)
+
+#include "../../gsmcomon.h"
+#include "obex.h"
+
+static GSM_Error OBEX_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 + 3);
+
+ OBEXAddBlock(out_buffer, &current, type, buffer, length);
+
+ GSM_DumpMessageLevel2(s, out_buffer+3, length, type);
+ GSM_DumpMessageLevel3(s, out_buffer+3, length, type);
+
+ /* Send it out... */
+ sent = s->Device.Functions->WriteDevice(s,out_buffer,current);
+
+ free(out_buffer);
+
+ if (sent!=current) return ERR_DEVICEWRITEERROR;
+ return ERR_NONE;
+}
+
+static GSM_Error OBEX_StateMachine(GSM_StateMachine *s, unsigned char rx_char)
+{
+ GSM_Phone_Functions *Phone = s->Phone.Functions;
+ GSM_Protocol_OBEXData *d = &s->Protocol.Data.OBEX;
+
+ switch (d->MsgRXState) {
+ case RX_Sync:
+ d->Msg.Type = rx_char;
+ d->MsgRXState = RX_GetLength1;
+ break;
+ case RX_GetLength1:
+ d->Msg.Length = rx_char * 256;
+ d->MsgRXState = RX_GetLength2;
+ break;
+ case RX_GetLength2:
+ d->Msg.Length = d->Msg.Length + rx_char - 3;
+ d->Msg.Count = 0;
+ if (d->Msg.Count == d->Msg.Length) {
+ s->Phone.Data.RequestMsg = &d->Msg;
+ s->Phone.Data.DispatchError = Phone->DispatchMessage(s);
+ d->MsgRXState = RX_Sync;
+ } else {
+ if (d->Msg.BufferUsed < d->Msg.Length) {
+ d->Msg.BufferUsed = d->Msg.Length;
+ d->Msg.Buffer = (unsigned char *)realloc(d->Msg.Buffer,d->Msg.BufferUsed);
+ }
+ d->MsgRXState = RX_GetMessage;
+ }
+ break;
+ case RX_GetMessage:
+ d->Msg.Buffer[d->Msg.Count] = rx_char;
+ d->Msg.Count++;
+ if (d->Msg.Count == d->Msg.Length) {
+ s->Phone.Data.RequestMsg = &d->Msg;
+ s->Phone.Data.DispatchError = Phone->DispatchMessage(s);
+ d->MsgRXState = RX_Sync;
+ }
+ break;
+ }
+
+ return ERR_NONE;
+}
+
+static GSM_Error OBEX_Initialise(GSM_StateMachine *s)
+{
+ GSM_Protocol_OBEXData *d = &s->Protocol.Data.OBEX;
+
+ d->Msg.BufferUsed = 0;
+ d->Msg.Buffer = NULL;
+ d->Msg.Length = 0;
+
+ d->MsgRXState = RX_Sync;
+
+ return ERR_NONE;
+}
+
+static GSM_Error OBEX_Terminate(GSM_StateMachine *s)
+{
+ free(s->Protocol.Data.OBEX.Msg.Buffer);
+ return ERR_NONE;
+}
+
+GSM_Protocol_Functions OBEXProtocol = {
+ OBEX_WriteMessage,
+ OBEX_StateMachine,
+ OBEX_Initialise,
+ OBEX_Terminate
+};
+
+#endif
+
+void OBEXAddBlock(char *Buffer, int *Pos, unsigned char ID, char *AddBuffer, int AddLength)
+{
+ Buffer[(*Pos)++] = ID;
+ Buffer[(*Pos)++] = (AddLength+3)/256;
+ Buffer[(*Pos)++] = (AddLength+3)%256;
+ if (AddBuffer != NULL) {
+ memcpy(Buffer+(*Pos),AddBuffer,AddLength);
+ (*Pos) += AddLength;
+ }
+}
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */
diff --git a/gammu/emb/common/protocol/obex/obex.h b/gammu/emb/common/protocol/obex/obex.h
new file mode 100644
index 0000000..0e927c7
--- a/dev/null
+++ b/gammu/emb/common/protocol/obex/obex.h
@@ -0,0 +1,33 @@
+/* (c) 2003 by Marcin Wiacek */
+
+#ifndef obex_h
+#define obex_h
+
+#include "../protocol.h"
+
+typedef struct {
+ int MsgRXState;
+ GSM_Protocol_Message Msg;
+} GSM_Protocol_OBEXData;
+
+#ifndef GSM_USED_SERIALDEVICE
+# define GSM_USED_SERIALDEVICE
+#endif
+#if defined(GSM_ENABLE_BLUEOBEX)
+# ifndef GSM_USED_BLUETOOTHDEVICE
+# define GSM_USED_BLUETOOTHDEVICE
+# endif
+#endif
+#if defined(GSM_ENABLE_IRDAOBEX)
+# ifndef GSM_USED_IRDADEVICE
+# define GSM_USED_IRDADEVICE
+# endif
+#endif
+
+void OBEXAddBlock(char *Buffer, int *Pos, unsigned char ID, char *AddBuffer, int AddLength);
+
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */