1 | #define MODULE_LOG_PREFIX "dvbstapi"
|
---|
2 |
|
---|
3 | #include "globals.h"
|
---|
4 |
|
---|
5 | #if defined(HAVE_DVBAPI) && defined(WITH_STAPI)
|
---|
6 |
|
---|
7 | #include "module-dvbapi.h"
|
---|
8 | #include "module-dvbapi-stapi.h"
|
---|
9 | #include "oscam-client.h"
|
---|
10 | #include "oscam-files.h"
|
---|
11 | #include "oscam-string.h"
|
---|
12 | #include "oscam-time.h"
|
---|
13 |
|
---|
14 | struct STDEVICE
|
---|
15 | {
|
---|
16 | char name[20];
|
---|
17 | uint32_t SessionHandle;
|
---|
18 | uint32_t SignalHandle;
|
---|
19 | pthread_t thread;
|
---|
20 | struct filter_s demux_fd[MAX_DEMUX][MAX_FILTER];
|
---|
21 | };
|
---|
22 |
|
---|
23 | struct read_thread_param
|
---|
24 | {
|
---|
25 | int32_t id;
|
---|
26 | struct s_client *cli;
|
---|
27 | };
|
---|
28 |
|
---|
29 | #define BUFFLEN 1024
|
---|
30 | #define PROCDIR "/proc/stpti4_core/"
|
---|
31 |
|
---|
32 | /* These functions are in liboscam_stapi.a */
|
---|
33 | extern uint32_t oscam_stapi_Capability(char *name);
|
---|
34 | extern char *oscam_stapi_LibVersion(void);
|
---|
35 | extern uint32_t oscam_stapi_Open(char *name, uint32_t *sessionhandle);
|
---|
36 | extern uint32_t oscam_stapi_SignalAllocate(uint32_t sessionhandle, uint32_t *signalhandle);
|
---|
37 | extern uint32_t oscam_stapi_FilterAllocate(uint32_t sessionhandle, uint32_t *filterhandle);
|
---|
38 | extern uint32_t oscam_stapi_SlotInit(uint32_t sessionhandle, uint32_t signalhandle, uint32_t *bufferhandle, uint32_t *slothandle, uint16_t pid);
|
---|
39 | extern uint32_t oscam_stapi_FilterSet(uint32_t filterhandle, uchar *filt, uchar *mask);
|
---|
40 | extern uint32_t oscam_stapi_FilterAssociate(uint32_t filterhandle, uint32_t slothandle);
|
---|
41 | extern uint32_t oscam_stapi_SlotDeallocate(uint32_t slothandle);
|
---|
42 | extern uint32_t oscam_stapi_BufferDeallocate(uint32_t bufferhandle);
|
---|
43 | extern uint32_t oscam_stapi_FilterDeallocate(uint32_t filterhandle);
|
---|
44 | extern uint32_t oscam_stapi_Close(uint32_t sessionhandle);
|
---|
45 | extern uint32_t oscam_stapi_CheckVersion(void);
|
---|
46 | extern uint32_t oscam_stapi_DescramblerAssociate(uint32_t deschandle, uint32_t slot);
|
---|
47 | extern uint32_t oscam_stapi_DescramblerDisassociate(uint32_t deschandle, uint32_t slot);
|
---|
48 | extern uint32_t oscam_stapi_DescramblerAllocate(uint32_t sessionhandle, uint32_t *deschandle);
|
---|
49 | extern uint32_t oscam_stapi_DescramblerDeallocate(uint32_t deschandle);
|
---|
50 | extern uint32_t oscam_stapi_DescramblerSet(uint32_t deschandle, int32_t parity, uchar *cw);
|
---|
51 | extern uint32_t oscam_stapi_SignalWaitBuffer(uint32_t signalhandle, uint32_t *qbuffer, int32_t timeout);
|
---|
52 | extern uint32_t oscam_stapi_BufferReadSection(uint32_t bufferhandle, uint32_t *filterlist, int32_t maxfilter, uint32_t *filtercount, int32_t *crc, uchar *buf, int32_t bufsize, uint32_t *size);
|
---|
53 | extern uint32_t oscam_stapi_SignalAbort(uint32_t signalhandle);
|
---|
54 | extern uint32_t oscam_stapi_PidQuery(char *name, uint16_t pid);
|
---|
55 | extern uint32_t oscam_stapi_BufferFlush(uint32_t bufferhandle);
|
---|
56 | extern uint32_t oscam_stapi_SlotClearPid(uint32_t slot);
|
---|
57 |
|
---|
58 | // Local functions
|
---|
59 | static void *stapi_read_thread(void *);
|
---|
60 | static int32_t stapi_do_set_filter(int32_t demux_id, FILTERTYPE *filter, uint16_t *pids, int32_t pidcount, uchar *filt, uchar *mask, int32_t dev_id);
|
---|
61 | static int32_t stapi_do_remove_filter(int32_t demux_id, FILTERTYPE *filter, int32_t dev_id);
|
---|
62 |
|
---|
63 | // These variables are declared in module-dvbapi.c
|
---|
64 | extern int32_t disable_pmt_files;
|
---|
65 | extern struct s_dvbapi_priority *dvbapi_priority;
|
---|
66 | extern DEMUXTYPE demux[MAX_DEMUX];
|
---|
67 |
|
---|
68 | static int32_t stapi_on;
|
---|
69 | static pthread_mutex_t filter_lock;
|
---|
70 | static struct STDEVICE dev_list[PTINUM];
|
---|
71 |
|
---|
72 | static void stapi_off(void)
|
---|
73 | {
|
---|
74 | int32_t i;
|
---|
75 |
|
---|
76 | pthread_mutex_lock(&filter_lock);
|
---|
77 |
|
---|
78 | cs_log("stapi shutdown");
|
---|
79 |
|
---|
80 | disable_pmt_files = 1;
|
---|
81 | stapi_on = 0;
|
---|
82 | for(i = 0; i < MAX_DEMUX; i++)
|
---|
83 | {
|
---|
84 | dvbapi_stop_descrambling(i);
|
---|
85 | }
|
---|
86 |
|
---|
87 | for(i = 0; i < PTINUM; i++)
|
---|
88 | {
|
---|
89 | if(dev_list[i].SessionHandle > 0)
|
---|
90 | {
|
---|
91 | if(dev_list[i].SignalHandle > 0)
|
---|
92 | {
|
---|
93 | oscam_stapi_SignalAbort(dev_list[i].SignalHandle);
|
---|
94 | }
|
---|
95 | pthread_cancel(dev_list[i].thread);
|
---|
96 | }
|
---|
97 | }
|
---|
98 |
|
---|
99 | pthread_mutex_unlock(&filter_lock);
|
---|
100 | sleep(2);
|
---|
101 | return;
|
---|
102 | }
|
---|
103 |
|
---|
104 | int32_t stapi_open(void)
|
---|
105 | {
|
---|
106 | uint32_t ErrorCode;
|
---|
107 |
|
---|
108 | DIR *dirp;
|
---|
109 | struct dirent entry, *dp = NULL;
|
---|
110 | struct stat buf;
|
---|
111 | int32_t i;
|
---|
112 | char pfad[80];
|
---|
113 | stapi_on = 1;
|
---|
114 | int32_t stapi_priority = 0;
|
---|
115 |
|
---|
116 | dirp = opendir(PROCDIR);
|
---|
117 | if(!dirp)
|
---|
118 | {
|
---|
119 | cs_log("opendir failed (errno=%d %s)", errno, strerror(errno));
|
---|
120 | return 0;
|
---|
121 | }
|
---|
122 |
|
---|
123 | memset(dev_list, 0, sizeof(struct STDEVICE)*PTINUM);
|
---|
124 |
|
---|
125 | if(dvbapi_priority)
|
---|
126 | {
|
---|
127 | struct s_dvbapi_priority *p;
|
---|
128 | for(p = dvbapi_priority; p != NULL; p = p->next)
|
---|
129 | {
|
---|
130 | if(p->type == 's')
|
---|
131 | {
|
---|
132 | stapi_priority = 1;
|
---|
133 | break;
|
---|
134 | }
|
---|
135 | }
|
---|
136 | }
|
---|
137 |
|
---|
138 | if(!stapi_priority)
|
---|
139 | {
|
---|
140 | cs_log("WARNING: no PTI devices defined, stapi disabled");
|
---|
141 | return 0;
|
---|
142 | }
|
---|
143 |
|
---|
144 | oscam_stapi_CheckVersion();
|
---|
145 |
|
---|
146 | i = 0;
|
---|
147 | while(!cs_readdir_r(dirp, &entry, &dp))
|
---|
148 | {
|
---|
149 | if(!dp) { break; }
|
---|
150 |
|
---|
151 | snprintf(pfad, sizeof(pfad), "%s%s", PROCDIR, dp->d_name);
|
---|
152 | if(stat(pfad, &buf) != 0)
|
---|
153 | { continue; }
|
---|
154 |
|
---|
155 | if(!(buf.st_mode & S_IFDIR && strncmp(dp->d_name, ".", 1) != 0))
|
---|
156 | { continue; }
|
---|
157 |
|
---|
158 | int32_t do_open = 0;
|
---|
159 | struct s_dvbapi_priority *p;
|
---|
160 |
|
---|
161 | for(p = dvbapi_priority; p != NULL; p = p->next)
|
---|
162 | {
|
---|
163 | if(p->type != 's') { continue; }
|
---|
164 | if(strcmp(dp->d_name, p->devname) == 0)
|
---|
165 | {
|
---|
166 | do_open = 1;
|
---|
167 | break;
|
---|
168 | }
|
---|
169 | }
|
---|
170 |
|
---|
171 | if(!do_open)
|
---|
172 | {
|
---|
173 | cs_log("PTI: %s skipped", dp->d_name);
|
---|
174 | continue;
|
---|
175 | }
|
---|
176 |
|
---|
177 | ErrorCode = oscam_stapi_Open(dp->d_name, &dev_list[i].SessionHandle);
|
---|
178 | if(ErrorCode != 0)
|
---|
179 | {
|
---|
180 | cs_log("STPTI_Open ErrorCode: %d", ErrorCode);
|
---|
181 | continue;
|
---|
182 | }
|
---|
183 |
|
---|
184 | //debug
|
---|
185 | //oscam_stapi_Capability(dp->d_name);
|
---|
186 |
|
---|
187 | cs_strncpy(dev_list[i].name, dp->d_name, sizeof(dev_list[i].name));
|
---|
188 | cs_log("PTI: %s open %d", dp->d_name, i);
|
---|
189 |
|
---|
190 | ErrorCode = oscam_stapi_SignalAllocate(dev_list[i].SessionHandle, &dev_list[i].SignalHandle);
|
---|
191 | if(ErrorCode != 0)
|
---|
192 | { cs_log("SignalAllocate: ErrorCode: %d SignalHandle: %x", ErrorCode, dev_list[i].SignalHandle); }
|
---|
193 |
|
---|
194 | i++;
|
---|
195 | if(i >= PTINUM) { break; }
|
---|
196 | }
|
---|
197 | closedir(dirp);
|
---|
198 |
|
---|
199 | if(i == 0) { return 0; }
|
---|
200 |
|
---|
201 | pthread_mutex_init(&filter_lock, NULL);
|
---|
202 |
|
---|
203 | for(i = 0; i < PTINUM; i++)
|
---|
204 | {
|
---|
205 | if(dev_list[i].SessionHandle == 0)
|
---|
206 | { continue; }
|
---|
207 |
|
---|
208 | struct read_thread_param *para;
|
---|
209 | if(!cs_malloc(¶, sizeof(struct read_thread_param)))
|
---|
210 | { return 0; }
|
---|
211 | para->id = i;
|
---|
212 | para->cli = cur_client();
|
---|
213 |
|
---|
214 | int32_t ret = pthread_create(&dev_list[i].thread, NULL, stapi_read_thread, (void *)para);
|
---|
215 | if(ret)
|
---|
216 | {
|
---|
217 | cs_log("ERROR: can't create stapi read thread (errno=%d %s)", ret, strerror(ret));
|
---|
218 | return 0;
|
---|
219 | }
|
---|
220 | else
|
---|
221 | { pthread_detach(dev_list[i].thread); }
|
---|
222 | }
|
---|
223 |
|
---|
224 | atexit(stapi_off);
|
---|
225 |
|
---|
226 | cs_log("liboscam_stapi v.%s initialized", oscam_stapi_LibVersion());
|
---|
227 | return 1;
|
---|
228 | }
|
---|
229 |
|
---|
230 | int32_t stapi_activate_section_filter(int32_t fd, uchar *filter, uchar *mask)
|
---|
231 | {
|
---|
232 | int n=0, ret=852049;
|
---|
233 | while (n<3 && ret==852049) {
|
---|
234 | ret = oscam_stapi_FilterSet(fd, filter, mask);
|
---|
235 | if(ret) {
|
---|
236 | cs_log_dbg(D_DVBAPI, "Error: oscam_stapi_FilterSet; %d", ret);
|
---|
237 | cs_sleepms(50);
|
---|
238 | n++;
|
---|
239 | }
|
---|
240 | }
|
---|
241 | if(ret) {
|
---|
242 | cs_log("Error: stapi_activate_section_filter: %d", ret);
|
---|
243 | ret = -1;
|
---|
244 | }
|
---|
245 | return ret;
|
---|
246 | }
|
---|
247 |
|
---|
248 | int32_t stapi_set_filter(int32_t demux_id, uint16_t pid, uchar *filter, uchar *mask, int32_t num, char *pmtfile)
|
---|
249 | {
|
---|
250 | int32_t i;
|
---|
251 | int32_t ret = -1;
|
---|
252 | char dest[1024];
|
---|
253 | uint16_t pids[1] = { pid };
|
---|
254 | struct s_dvbapi_priority *p;
|
---|
255 |
|
---|
256 | if(!pmtfile)
|
---|
257 | {
|
---|
258 | cs_log_dbg(D_DVBAPI, "No valid pmtfile!");
|
---|
259 | return -1;
|
---|
260 | }
|
---|
261 |
|
---|
262 | cs_log_dbg(D_DVBAPI, "pmt file %s demux_id %d", pmtfile, demux_id);
|
---|
263 |
|
---|
264 | for(p = dvbapi_priority; p != NULL; p = p->next)
|
---|
265 | {
|
---|
266 | if(p->type != 's') { continue; } // stapi rule?
|
---|
267 | if(strcmp(pmtfile, p->pmtfile) != 0) { continue; } // same file?
|
---|
268 |
|
---|
269 | for(i = 0; i < PTINUM; i++)
|
---|
270 | {
|
---|
271 | if(strcmp(dev_list[i].name, p->devname) == 0 && p->disablefilter == 0) // check device name and if filtering is enabled!
|
---|
272 | {
|
---|
273 | cs_log_dbg(D_DVBAPI, "set stapi filter on %s for pid %04X", dev_list[i].name, pids[0]);
|
---|
274 | ret = stapi_do_set_filter(demux_id, &dev_list[i].demux_fd[demux_id][num], pids, 1, filter, mask, i);
|
---|
275 | if(ret > 0) // success
|
---|
276 | {
|
---|
277 | cs_log_dbg(D_DVBAPI, "%s filter %d set (pid %04X)", dev_list[i].name, num, pid);
|
---|
278 | return ret; // return filternumber
|
---|
279 | }
|
---|
280 | else // failure
|
---|
281 | {
|
---|
282 | cs_log_dbg(D_DVBAPI, "Error setting new filter for pid %04X on %s!", pid, dev_list[i].name);
|
---|
283 | return -1; // set return to error
|
---|
284 | }
|
---|
285 | }
|
---|
286 | }
|
---|
287 | }
|
---|
288 |
|
---|
289 | if(p == NULL)
|
---|
290 | {
|
---|
291 | cs_log_dbg(D_DVBAPI, "No matching S: line in oscam.dvbapi for pmtfile %s -> stop descrambling!", pmtfile);
|
---|
292 | snprintf(dest, sizeof(dest), "%s%s", TMPDIR, demux[demux_id].pmt_file);
|
---|
293 | unlink(dest); // remove obsolete pmt file
|
---|
294 | dvbapi_stop_descrambling(demux_id);
|
---|
295 | }
|
---|
296 | return ret;
|
---|
297 | }
|
---|
298 |
|
---|
299 | int32_t stapi_remove_filter(int32_t demux_id, int32_t num, char *pmtfile)
|
---|
300 | {
|
---|
301 | int32_t i, ret = 0;
|
---|
302 | struct s_dvbapi_priority *p;
|
---|
303 |
|
---|
304 | if(!pmtfile) { return 0; }
|
---|
305 |
|
---|
306 | for(p = dvbapi_priority; p != NULL; p = p->next)
|
---|
307 | {
|
---|
308 | if(p->type != 's') { continue; }
|
---|
309 | if(strcmp(pmtfile, p->pmtfile) != 0)
|
---|
310 | { continue; }
|
---|
311 |
|
---|
312 | for(i = 0; i < PTINUM; i++)
|
---|
313 | {
|
---|
314 | if(strcmp(dev_list[i].name, p->devname) == 0 && p->disablefilter == 0)
|
---|
315 | {
|
---|
316 | ret = stapi_do_remove_filter(demux_id, &dev_list[i].demux_fd[demux_id][num], i);
|
---|
317 | }
|
---|
318 | }
|
---|
319 | }
|
---|
320 | if(ret == 1)
|
---|
321 | {
|
---|
322 | cs_log_dbg(D_DVBAPI, "filter %d removed", num);
|
---|
323 | }
|
---|
324 | else
|
---|
325 | {
|
---|
326 | cs_log_dbg(D_DVBAPI, "Error: filter %d was not removed!", num);
|
---|
327 | }
|
---|
328 | return ret;
|
---|
329 | }
|
---|
330 |
|
---|
331 | static uint32_t check_slot(int32_t dev_id, uint32_t checkslot, FILTERTYPE *skipfilter)
|
---|
332 | {
|
---|
333 | int32_t d, f, l;
|
---|
334 | for(d = 0; d < MAX_DEMUX; d++)
|
---|
335 | {
|
---|
336 | for(f = 0; f < MAX_FILTER; f++)
|
---|
337 | {
|
---|
338 | if(skipfilter && &dev_list[dev_id].demux_fd[d][f] == skipfilter)
|
---|
339 | { continue; }
|
---|
340 | for(l = 0; l < dev_list[dev_id].demux_fd[d][f].NumSlots; l++)
|
---|
341 | {
|
---|
342 | if(checkslot == dev_list[dev_id].demux_fd[d][f].SlotHandle[l])
|
---|
343 | {
|
---|
344 | return dev_list[dev_id].demux_fd[d][f].BufferHandle[l];
|
---|
345 | }
|
---|
346 | }
|
---|
347 | }
|
---|
348 | }
|
---|
349 | return 0;
|
---|
350 | }
|
---|
351 |
|
---|
352 |
|
---|
353 | static int32_t stapi_do_set_filter(int32_t demux_id, FILTERTYPE *filter, uint16_t *pids, int32_t pidcount, uchar *filt, uchar *mask, int32_t dev_id)
|
---|
354 | {
|
---|
355 | uint32_t FilterAssociateError = 0;
|
---|
356 | int32_t k, ret = 0;
|
---|
357 |
|
---|
358 | filter->fd = 0;
|
---|
359 | filter->BufferHandle[0] = 0;
|
---|
360 | filter->SlotHandle[0] = 0;
|
---|
361 |
|
---|
362 | if(dev_list[dev_id].SessionHandle == 0) { return 0; }
|
---|
363 |
|
---|
364 | uint32_t FilterAllocateError = oscam_stapi_FilterAllocate(dev_list[dev_id].SessionHandle, &filter->fd);
|
---|
365 |
|
---|
366 | if(FilterAllocateError != 0)
|
---|
367 | {
|
---|
368 | cs_log("FilterAllocate problem");
|
---|
369 | filter->fd = 0;
|
---|
370 | return 0;
|
---|
371 | }
|
---|
372 |
|
---|
373 | for(k = 0; k < pidcount; k++)
|
---|
374 | {
|
---|
375 | uint16_t pid = pids[k];
|
---|
376 |
|
---|
377 | uint32_t QuerySlot = oscam_stapi_PidQuery(dev_list[dev_id].name, pid);
|
---|
378 | int32_t SlotInit = 1;
|
---|
379 |
|
---|
380 | if(QuerySlot != 0)
|
---|
381 | {
|
---|
382 | uint32_t checkslot = check_slot(dev_id, QuerySlot, NULL);
|
---|
383 | if(checkslot > 0)
|
---|
384 | {
|
---|
385 | filter->SlotHandle[k] = QuerySlot;
|
---|
386 | filter->BufferHandle[k] = checkslot;
|
---|
387 | SlotInit = 0;
|
---|
388 | }
|
---|
389 | else
|
---|
390 | {
|
---|
391 | cs_log("overtake: clear pid: %d", oscam_stapi_SlotClearPid(QuerySlot));
|
---|
392 | SlotInit = 1;
|
---|
393 | }
|
---|
394 | }
|
---|
395 |
|
---|
396 | if(SlotInit == 1)
|
---|
397 | {
|
---|
398 | ret = oscam_stapi_SlotInit(dev_list[dev_id].SessionHandle, dev_list[dev_id].SignalHandle, &filter->BufferHandle[k], &filter->SlotHandle[k], pid);
|
---|
399 | }
|
---|
400 |
|
---|
401 | FilterAssociateError = oscam_stapi_FilterAssociate(filter->fd, filter->SlotHandle[k]);
|
---|
402 | filter->NumSlots++;
|
---|
403 | }
|
---|
404 |
|
---|
405 | uint32_t FilterSetError = oscam_stapi_FilterSet(filter->fd, filt, mask);
|
---|
406 |
|
---|
407 | if(ret || FilterAllocateError || FilterAssociateError || FilterSetError)
|
---|
408 | {
|
---|
409 | cs_log("set_filter: dev: %d FAl: %d FAs: %d FS: %d",
|
---|
410 | dev_id, FilterAllocateError, FilterAssociateError, FilterSetError);
|
---|
411 | stapi_do_remove_filter(demux_id, filter, dev_id);
|
---|
412 | return 0;
|
---|
413 | }
|
---|
414 | else
|
---|
415 | {
|
---|
416 | return filter->fd; // return fd of filter
|
---|
417 | }
|
---|
418 | }
|
---|
419 |
|
---|
420 | static int32_t stapi_do_remove_filter(int32_t UNUSED(demux_id), FILTERTYPE *filter, int32_t dev_id)
|
---|
421 | {
|
---|
422 | if(filter->fd == 0) { return 0; }
|
---|
423 |
|
---|
424 | uint32_t BufferDeallocateError = 0, SlotDeallocateError = 0;
|
---|
425 |
|
---|
426 | if(dev_list[dev_id].SessionHandle == 0) { return 0; }
|
---|
427 |
|
---|
428 | int32_t k;
|
---|
429 | for(k = 0; k < filter->NumSlots; k++)
|
---|
430 | {
|
---|
431 | uint32_t checkslot = check_slot(dev_id, filter->SlotHandle[k], filter);
|
---|
432 |
|
---|
433 | if(checkslot == 0)
|
---|
434 | {
|
---|
435 | BufferDeallocateError = oscam_stapi_BufferDeallocate(filter->BufferHandle[k]);
|
---|
436 | SlotDeallocateError = oscam_stapi_SlotDeallocate(filter->SlotHandle[k]);
|
---|
437 | }
|
---|
438 | }
|
---|
439 | uint32_t FilterDeallocateError = oscam_stapi_FilterDeallocate(filter->fd);
|
---|
440 |
|
---|
441 | memset(filter, 0, sizeof(FILTERTYPE));
|
---|
442 |
|
---|
443 | if(BufferDeallocateError || SlotDeallocateError || FilterDeallocateError)
|
---|
444 | {
|
---|
445 | cs_log("remove_filter: dev: %d BD: %d SD: %d FDe: %d",
|
---|
446 | dev_id, BufferDeallocateError, SlotDeallocateError, FilterDeallocateError);
|
---|
447 | return 0;
|
---|
448 | }
|
---|
449 | else
|
---|
450 | {
|
---|
451 | return 1;
|
---|
452 | }
|
---|
453 | }
|
---|
454 |
|
---|
455 | static void stapi_cleanup_thread(void *dev)
|
---|
456 | {
|
---|
457 | int32_t dev_index = (int)dev;
|
---|
458 |
|
---|
459 | int32_t ErrorCode;
|
---|
460 | ErrorCode = oscam_stapi_Close(dev_list[dev_index].SessionHandle);
|
---|
461 |
|
---|
462 | printf("liboscam_stapi: PTI %s closed - %d\n", dev_list[dev_index].name, ErrorCode);
|
---|
463 | dev_list[dev_index].SessionHandle = 0;
|
---|
464 | }
|
---|
465 |
|
---|
466 | static void *stapi_read_thread(void *sparam)
|
---|
467 | {
|
---|
468 | int32_t dev_index, ErrorCode, i, j, CRCValid;
|
---|
469 | uint32_t QueryBufferHandle = 0, DataSize = 0;
|
---|
470 | uchar buf[BUFFLEN];
|
---|
471 |
|
---|
472 | struct read_thread_param *para = sparam;
|
---|
473 | dev_index = para->id;
|
---|
474 |
|
---|
475 | pthread_setspecific(getclient, para->cli);
|
---|
476 | pthread_setcanceltype(PTHREAD_CANCEL_ASYNCHRONOUS, NULL);
|
---|
477 | pthread_cleanup_push(stapi_cleanup_thread, (void *) dev_index);
|
---|
478 |
|
---|
479 | int32_t error_count = 0;
|
---|
480 |
|
---|
481 | while(1)
|
---|
482 | {
|
---|
483 | QueryBufferHandle = 0;
|
---|
484 | ErrorCode = oscam_stapi_SignalWaitBuffer(dev_list[dev_index].SignalHandle, &QueryBufferHandle, 1000);
|
---|
485 |
|
---|
486 | switch(ErrorCode)
|
---|
487 | {
|
---|
488 | case 0: // NO_ERROR:
|
---|
489 | break;
|
---|
490 | case 852042: // ERROR_SIGNAL_ABORTED
|
---|
491 | cs_log("Caught abort signal");
|
---|
492 | pthread_exit(NULL);
|
---|
493 | break;
|
---|
494 | case 11: // ERROR_TIMEOUT:
|
---|
495 | //cs_log("timeout %d", dev_index);
|
---|
496 | //TODO: if pidindex == -1 try next
|
---|
497 | continue;
|
---|
498 | break;
|
---|
499 | default:
|
---|
500 | if(QueryBufferHandle != 0)
|
---|
501 | {
|
---|
502 | cs_log("SignalWaitBuffer error: %d", ErrorCode);
|
---|
503 | oscam_stapi_BufferFlush(QueryBufferHandle);
|
---|
504 | continue;
|
---|
505 | }
|
---|
506 | cs_log("SignalWaitBuffer: index %d ErrorCode: %d - QueryBuffer: %x", dev_index, ErrorCode, QueryBufferHandle);
|
---|
507 | error_count++;
|
---|
508 | if(error_count > 10)
|
---|
509 | {
|
---|
510 | cs_log("Too many errors in reader thread %d, quitting.", dev_index);
|
---|
511 | pthread_exit(NULL);
|
---|
512 | }
|
---|
513 | continue;
|
---|
514 | break;
|
---|
515 | }
|
---|
516 |
|
---|
517 | uint32_t NumFilterMatches = 0;
|
---|
518 | int32_t demux_id = 0, filter_num = 0;
|
---|
519 | DataSize = 0;
|
---|
520 | uint32_t k;
|
---|
521 |
|
---|
522 | uint32_t MatchedFilterList[10];
|
---|
523 | ErrorCode = oscam_stapi_BufferReadSection(QueryBufferHandle, MatchedFilterList, 10, &NumFilterMatches, &CRCValid, buf, BUFFLEN, &DataSize);
|
---|
524 |
|
---|
525 | if(ErrorCode != 0)
|
---|
526 | {
|
---|
527 | cs_log("BufferRead: index: %d ErrorCode: %d", dev_index, ErrorCode);
|
---|
528 | cs_sleepms(1000);
|
---|
529 | continue;
|
---|
530 | }
|
---|
531 |
|
---|
532 | if(DataSize <= 0)
|
---|
533 | { continue; }
|
---|
534 |
|
---|
535 | pthread_mutex_lock(&filter_lock); // don't use cs_lock() here; multiple threads using same s_client struct
|
---|
536 | for(k = 0; k < NumFilterMatches; k++)
|
---|
537 | {
|
---|
538 | for(i = 0; i < MAX_DEMUX; i++)
|
---|
539 | {
|
---|
540 | for(j = 0; j < MAX_FILTER; j++)
|
---|
541 | {
|
---|
542 | if(dev_list[dev_index].demux_fd[i][j].fd == MatchedFilterList[k])
|
---|
543 | {
|
---|
544 | demux_id = i;
|
---|
545 | filter_num = j;
|
---|
546 |
|
---|
547 | dvbapi_process_input(demux_id, filter_num, buf, DataSize);
|
---|
548 | }
|
---|
549 | }
|
---|
550 | }
|
---|
551 | }
|
---|
552 | pthread_mutex_unlock(&filter_lock);
|
---|
553 | }
|
---|
554 | pthread_cleanup_pop(0);
|
---|
555 | }
|
---|
556 |
|
---|
557 | #define ASSOCIATE 1
|
---|
558 | #define DISASSOCIATE 0
|
---|
559 |
|
---|
560 | #define DE_START 0
|
---|
561 | #define DE_STOP 1
|
---|
562 |
|
---|
563 | static void stapi_DescramblerAssociate(int32_t demux_id, uint16_t pid, int32_t mode, int32_t n)
|
---|
564 | {
|
---|
565 | uint32_t Slot = 0;
|
---|
566 | int32_t ErrorCode = 0;
|
---|
567 |
|
---|
568 | if(dev_list[n].SessionHandle == 0) { return; }
|
---|
569 |
|
---|
570 | Slot = oscam_stapi_PidQuery(dev_list[n].name, pid);
|
---|
571 | if(!Slot) { return; }
|
---|
572 |
|
---|
573 | if(demux[demux_id].DescramblerHandle[n] == 0) { return; }
|
---|
574 |
|
---|
575 | if(mode == ASSOCIATE)
|
---|
576 | {
|
---|
577 | int32_t k;
|
---|
578 | for(k = 0; k < SLOTNUM; k++)
|
---|
579 | {
|
---|
580 | if(demux[demux_id].slot_assc[n][k] == Slot)
|
---|
581 | {
|
---|
582 | return;
|
---|
583 | }
|
---|
584 | }
|
---|
585 |
|
---|
586 | ErrorCode = oscam_stapi_DescramblerAssociate(demux[demux_id].DescramblerHandle[n], Slot);
|
---|
587 | cs_log_dbg(D_DVBAPI, "set pid %04x on %s", pid, dev_list[n].name);
|
---|
588 |
|
---|
589 | if(ErrorCode != 0)
|
---|
590 | { cs_log("DescramblerAssociate %d", ErrorCode); }
|
---|
591 |
|
---|
592 | for(k = 0; k < SLOTNUM; k++)
|
---|
593 | {
|
---|
594 | if(demux[demux_id].slot_assc[n][k] == 0)
|
---|
595 | {
|
---|
596 | demux[demux_id].slot_assc[n][k] = Slot;
|
---|
597 | break;
|
---|
598 | }
|
---|
599 | }
|
---|
600 | }
|
---|
601 | else
|
---|
602 | {
|
---|
603 | ErrorCode = oscam_stapi_DescramblerDisassociate(demux[demux_id].DescramblerHandle[n], Slot);
|
---|
604 | if(ErrorCode != 0)
|
---|
605 | { cs_log_dbg(D_DVBAPI, "DescramblerDisassociate %d", ErrorCode); }
|
---|
606 |
|
---|
607 | cs_log_dbg(D_DVBAPI, "unset pid %04x on %s", pid, dev_list[n].name);
|
---|
608 |
|
---|
609 | int32_t k;
|
---|
610 | for(k = 0; k < SLOTNUM; k++)
|
---|
611 | {
|
---|
612 | if(demux[demux_id].slot_assc[n][k] == Slot)
|
---|
613 | {
|
---|
614 | demux[demux_id].slot_assc[n][k] = 0;
|
---|
615 | return;
|
---|
616 | }
|
---|
617 | }
|
---|
618 | }
|
---|
619 |
|
---|
620 | return;
|
---|
621 | }
|
---|
622 |
|
---|
623 | static void stapi_startdescrambler(int32_t demux_id, int32_t dev_index, int32_t mode)
|
---|
624 | {
|
---|
625 | int32_t ErrorCode;
|
---|
626 |
|
---|
627 | if(mode == DE_START && demux[demux_id].DescramblerHandle[dev_index] == 0)
|
---|
628 | {
|
---|
629 | uint32_t DescramblerHandle = 0;
|
---|
630 | ErrorCode = oscam_stapi_DescramblerAllocate(dev_list[dev_index].SessionHandle, &DescramblerHandle);
|
---|
631 | if(ErrorCode != 0)
|
---|
632 | {
|
---|
633 | cs_log("DescramblerAllocate: ErrorCode: %d SignalHandle: %x", ErrorCode, dev_list[dev_index].SignalHandle);
|
---|
634 | return;
|
---|
635 | }
|
---|
636 |
|
---|
637 | demux[demux_id].DescramblerHandle[dev_index] = DescramblerHandle;
|
---|
638 | }
|
---|
639 |
|
---|
640 | if(mode == DE_STOP && demux[demux_id].DescramblerHandle[dev_index] > 0)
|
---|
641 | {
|
---|
642 | ErrorCode = oscam_stapi_DescramblerDeallocate(demux[demux_id].DescramblerHandle[dev_index]);
|
---|
643 |
|
---|
644 | if(ErrorCode != 0)
|
---|
645 | { cs_log("DescramblerDeallocate: ErrorCode: %d", ErrorCode); }
|
---|
646 |
|
---|
647 | demux[demux_id].DescramblerHandle[dev_index] = 0;
|
---|
648 | }
|
---|
649 |
|
---|
650 | return;
|
---|
651 | }
|
---|
652 |
|
---|
653 | int32_t stapi_set_pid(int32_t demux_id, int32_t UNUSED(num), int32_t idx, uint16_t UNUSED(pid), char *UNUSED(pmtfile))
|
---|
654 | {
|
---|
655 | int32_t n;
|
---|
656 |
|
---|
657 | if(idx == -1)
|
---|
658 | {
|
---|
659 | for(n = 0; n < PTINUM; n++)
|
---|
660 | {
|
---|
661 | if(demux[demux_id].DescramblerHandle[n] == 0) { continue; }
|
---|
662 |
|
---|
663 | cs_log_dbg(D_DVBAPI, "stop descrambling PTI: %s", dev_list[n].name);
|
---|
664 | stapi_startdescrambler(demux_id, n, DE_STOP);
|
---|
665 | memset(demux[demux_id].slot_assc[n], 0, sizeof(demux[demux_id].slot_assc[n]));
|
---|
666 | }
|
---|
667 | }
|
---|
668 |
|
---|
669 | return 1;
|
---|
670 | }
|
---|
671 |
|
---|
672 | int32_t stapi_write_cw(int32_t demux_id, uchar *cw, uint16_t *STREAMpids, int32_t STREAMpidcount, char *pmtfile)
|
---|
673 | {
|
---|
674 | int32_t ErrorCode, l, n, k;
|
---|
675 | unsigned char nullcw[8];
|
---|
676 | memset(nullcw, 0, 8);
|
---|
677 | char *text[] = { "even", "odd" };
|
---|
678 |
|
---|
679 | if(!pmtfile) { return 0; }
|
---|
680 |
|
---|
681 | for(n = 0; n < PTINUM; n++)
|
---|
682 | {
|
---|
683 | if(dev_list[n].SessionHandle == 0) { continue; }
|
---|
684 | if(demux[demux_id].DescramblerHandle[n] == 0)
|
---|
685 | {
|
---|
686 | struct s_dvbapi_priority *p;
|
---|
687 |
|
---|
688 | for(p = dvbapi_priority; p != NULL; p = p->next)
|
---|
689 | {
|
---|
690 | if(p->type != 's') { continue; }
|
---|
691 | if(strcmp(pmtfile, p->pmtfile) != 0)
|
---|
692 | { continue; }
|
---|
693 |
|
---|
694 | if(strcmp(dev_list[n].name, p->devname) == 0)
|
---|
695 | {
|
---|
696 | cs_log_dbg(D_DVBAPI, "start descrambling PTI: %s", dev_list[n].name);
|
---|
697 | stapi_startdescrambler(demux_id, n, DE_START);
|
---|
698 | }
|
---|
699 | }
|
---|
700 | }
|
---|
701 |
|
---|
702 | if(demux[demux_id].DescramblerHandle[n] == 0) { continue; }
|
---|
703 |
|
---|
704 | int32_t pidnum = demux[demux_id].pidindex; // get current pidindex used for descrambling
|
---|
705 | int32_t idx = demux[demux_id].ECMpids[pidnum].index;
|
---|
706 |
|
---|
707 | if(!idx) // if no indexer for this pid get one!
|
---|
708 | {
|
---|
709 | idx = dvbapi_get_descindex(demux_id);
|
---|
710 | demux[demux_id].ECMpids[pidnum].index = idx;
|
---|
711 | cs_log_dbg(D_DVBAPI, "Demuxer %d PID: %d CAID: %04X ECMPID: %04X is using index %d", demux_id, pidnum,
|
---|
712 | demux[demux_id].ECMpids[pidnum].CAID, demux[demux_id].ECMpids[pidnum].ECM_PID, idx - 1);
|
---|
713 | }
|
---|
714 |
|
---|
715 | for(k = 0; k < STREAMpidcount; k++)
|
---|
716 | {
|
---|
717 | stapi_DescramblerAssociate(demux_id, STREAMpids[k], ASSOCIATE, n);
|
---|
718 | }
|
---|
719 | }
|
---|
720 |
|
---|
721 | for(l = 0; l < 2; l++)
|
---|
722 | {
|
---|
723 | if(memcmp(cw + (l * 8), demux[demux_id].lastcw[l], 8) != 0 && memcmp(cw + (l * 8), nullcw, 8) != 0)
|
---|
724 | {
|
---|
725 | for(n = 0; n < PTINUM; n++)
|
---|
726 | {
|
---|
727 | if(demux[demux_id].DescramblerHandle[n] == 0) { continue; }
|
---|
728 |
|
---|
729 | ErrorCode = oscam_stapi_DescramblerSet(demux[demux_id].DescramblerHandle[n], l, cw + (l * 8));
|
---|
730 | if(ErrorCode != 0)
|
---|
731 | { cs_log("DescramblerSet: ErrorCode: %d", ErrorCode); }
|
---|
732 |
|
---|
733 | memcpy(demux[demux_id].lastcw[l], cw + (l * 8), 8);
|
---|
734 | cs_log_dbg(D_DVBAPI, "write cw %s index: %d %s", text[l], demux_id, dev_list[n].name);
|
---|
735 | }
|
---|
736 | }
|
---|
737 | }
|
---|
738 |
|
---|
739 | return 1;
|
---|
740 | }
|
---|
741 |
|
---|
742 | // Needed for compatability with liboscam_stapi.a
|
---|
743 | #undef cs_log
|
---|
744 | void cs_log(const char *fmt, ...)
|
---|
745 | {
|
---|
746 | va_list params;
|
---|
747 | char log_txt[512];
|
---|
748 |
|
---|
749 | va_start(params, fmt);
|
---|
750 | vsnprintf(log_txt, sizeof(log_txt), fmt, params);
|
---|
751 | va_end(params);
|
---|
752 |
|
---|
753 | cs_log_txt(MODULE_LOG_PREFIX, "%s", log_txt);
|
---|
754 | }
|
---|
755 |
|
---|
756 | #endif
|
---|