/*
Copyright (C) JAEHYUK CHO
All rights reserved.
Author: JAEHYUK CHO <mailto:minzkn@minzkn.com>
*/
#include <stdio.h>
#include <stdlib.h>
#include <memory.h>
#include <unistd.h>
static __inline int __mzmatch_filter(const unsigned char *s_data, const unsigned char *s_mask, const unsigned char *s_mode, const unsigned char *s_comp, size_t s_size);
int mzmatch_filter(const void *s_data, const void *s_mask, const void *s_mode, const void *s_comp, size_t s_size);
static __inline int __mzmatch_filter(const unsigned char *s_data, const unsigned char *s_mask, const unsigned char *s_mode, const unsigned char *s_comp, size_t s_size)
{
size_t s_offset = (size_t)0;
unsigned char s_positive_mask, s_negative_mask;
while(s_offset < s_size) {
s_positive_mask = s_mask[s_offset] & s_mode[s_offset];
s_negative_mask = s_mask[s_offset] & (~s_mode[s_offset]);
if(((s_positive_mask & s_data[s_offset]) != (s_positive_mask & s_comp[s_offset])) ||
((s_negative_mask != ((unsigned char)0)) && ((s_negative_mask & (s_data[s_offset] ^ s_comp[s_offset])) == ((unsigned char)0)))) {
return(0);
}
s_offset++;
}
return(1);
}
int mzmatch_filter(const void *s_data, const void *s_mask, const void *s_mode, const void *s_comp, size_t s_size)
{
return(__mzmatch_filter((const unsigned char *)s_data, (const unsigned char *)s_mask, (const unsigned char *)s_mode, (const unsigned char *)s_comp, s_size));
}
void test(unsigned char s_mask, unsigned char s_mode, unsigned char s_comp)
{
int s_match_condition;
unsigned int s_data_min = 0x00u, s_data_max = 0xffu;
(void)fprintf(stdout, "TEST => data=%02X~%02X mask=%02X mode=%02X comp=%02X",
(unsigned int)s_data_min,
(unsigned int)s_data_max,
(unsigned int)s_mask,
(unsigned int)s_mode,
(unsigned int)s_comp
);
do {
if((s_data_min % 0x10u) == 0x00u)(void)fputs("\n", stdout);
s_match_condition = mzmatch_filter(&s_data_min, &s_mask, &s_mode, &s_comp, (size_t)1);
#if defined(__linux__) /* can use ansi code(escape sequence code) */
(void)fprintf(stdout,
" %s%02X\x1b[0m",
(s_match_condition == 0) ? "\x1b[1;31m" : "\x1b[1;33m",
(unsigned int)s_data_min);
#else
if(s_match_condition != 0) {
(void)fprintf(stdout,
" %02X",
(unsigned int)s_data_min);
}
#endif
}while((s_data_min++) < s_data_max);
(void)fputs("\n", stdout);
}
int main(void)
{
test(0xffu, 0xffu, 0x80u);
test(0xffu, 0x00u, 0x80u);
test(0xffu, 0xf9u, 0xceu);
test(0xffu, 0xf0u, 0x24u);
test(0x3fu, ~((unsigned char)0x3fu), 0x04u);
/* TS filter */
test(0xffu, 0xffu, 0x00u); /* PAT */
test(0xffu, 0xffu, 0x01u); /* CAT */
test(0xffu, 0xffu, 0x02u); /* PMT */
test(0xffu, 0xffu, 0x3eu); /* DSM CC */
test(0xfcu, 0xffu, 0x80u); /* ECM 0x80, 0x81, 0x82 */
return(EXIT_SUCCESS);
}