module-dvbapi-stapi5.c

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