Diffstat (limited to 'gammu/emb/common/protocol/obex/obex.c') (more/less context) (ignore whitespace changes)
| -rw-r--r-- | gammu/emb/common/protocol/obex/obex.c | 120 |
1 files changed, 120 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, ¤t, 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: + */ |