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
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
|
#include <stdio.h>
#include <stdlib.h>
#include <assert.h>
#include "pdispatch.h"
#include "protocol-native-spec.h"
struct reply_info {
struct pdispatch *pdispatch;
struct reply_info *next, *previous;
int (*callback)(struct pdispatch *pd, uint32_t command, uint32_t tag, struct tagstruct *t, void *userdata);
void *userdata;
uint32_t tag;
void *mainloop_timeout;
};
struct pdispatch {
struct pa_mainloop_api *mainloop;
const struct pdispatch_command *command_table;
unsigned n_commands;
struct reply_info *replies;
};
static void reply_info_free(struct reply_info *r) {
assert(r && r->pdispatch && r->pdispatch->mainloop);
r->pdispatch->mainloop->cancel_time(r->pdispatch->mainloop, r->mainloop_timeout);
if (r->previous)
r->previous->next = r->next;
else
r->pdispatch->replies = r->next;
if (r->next)
r->next->previous = r->previous;
free(r);
}
struct pdispatch* pdispatch_new(struct pa_mainloop_api *mainloop, const struct pdispatch_command*table, unsigned entries) {
struct pdispatch *pd;
assert(mainloop);
assert((entries && table) || (!entries && !table));
pd = malloc(sizeof(struct pdispatch));
assert(pd);
pd->mainloop = mainloop;
pd->command_table = table;
pd->n_commands = entries;
return pd;
}
void pdispatch_free(struct pdispatch *pd) {
assert(pd);
while (pd->replies)
reply_info_free(pd->replies);
free(pd);
}
int pdispatch_run(struct pdispatch *pd, struct packet*packet, void *userdata) {
uint32_t tag, command;
assert(pd && packet);
struct tagstruct *ts = NULL;
assert(pd && packet && packet->data);
if (packet->length <= 8)
goto fail;
ts = tagstruct_new(packet->data, packet->length);
assert(ts);
if (tagstruct_getu32(ts, &command) < 0 ||
tagstruct_getu32(ts, &tag) < 0)
goto fail;
if (command == PA_COMMAND_ERROR || command == PA_COMMAND_REPLY) {
struct reply_info *r;
int done = 0;
for (r = pd->replies; r; r = r->next) {
if (r->tag == tag) {
int ret = r->callback(r->pdispatch, command, tag, ts, r->userdata);
reply_info_free(r);
if (ret < 0)
goto fail;
done = 1;
break;
}
}
if (!done)
goto fail;
} else if (pd->command_table && command < pd->n_commands) {
const struct pdispatch_command *c = pd->command_table+command;
if (!c->proc)
goto fail;
if (c->proc(pd, command, tag, ts, userdata) < 0)
goto fail;
} else
goto fail;
tagstruct_free(ts);
return 0;
fail:
if (ts)
tagstruct_free(ts);
fprintf(stderr, "protocol-native: invalid packet.\n");
return -1;
}
static void timeout_callback(struct pa_mainloop_api*m, void *id, const struct timeval *tv, void *userdata) {
struct reply_info*r = userdata;
assert (r && r->mainloop_timeout == id && r->pdispatch && r->pdispatch->mainloop == m && r->callback);
r->callback(r->pdispatch, PA_COMMAND_TIMEOUT, r->tag, NULL, r->userdata);
reply_info_free(r);
}
void pdispatch_register_reply(struct pdispatch *pd, uint32_t tag, int timeout, int (*cb)(struct pdispatch *pd, uint32_t command, uint32_t tag, struct tagstruct *t, void *userdata), void *userdata) {
struct reply_info *r;
struct timeval tv;
assert(pd && cb);
r = malloc(sizeof(struct reply_info));
assert(r);
r->pdispatch = pd;
r->callback = cb;
r->userdata = userdata;
r->tag = tag;
gettimeofday(&tv, NULL);
tv.tv_sec += timeout;
r->mainloop_timeout = pd->mainloop->source_time(pd->mainloop, &tv, timeout_callback, r);
assert(r->mainloop_timeout);
r->previous = NULL;
r->next = pd->replies;
if (r->next)
r->next->previous = r;
pd->replies = r;
}
|
