1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
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:
*/
|
