./ MultiCS.r82 / dcwfilter.c
inline int checksumDCW(uint8_t *data) { if(data[3] != (byte)((data[0] + data[1] + data[2]) & 0xFF) || data[7] != (byte)((data[4] + data[5] + data[6]) & 0xFF)) { return 0; } if(data[11] != (byte)((data[8] + data[9] + data[10]) & 0xFF) || data[15] != (byte)((data[12] + data[13] + data[14]) & 0xFF)) { return 0; } return 1; } inline int isnullDCW(uint8_t *data) { int a0 = ( !data[0] && !data[1] && !data[2] ); int a1 = ( !data[4] && !data[5] && !data[6] ); int b0 = ( !data[8] && !data[9] && !data[10] ); int b1 = ( !data[12] && !data[13] && !data[14] ); return ( (a0||a1) && (b0||b1) ); } inline int isbadDCW(uint8_t *data) { if ( data[0]!=0 && data[0]==data[1] && data[0]==data[2] ) return 1; if ( data[4]!=0 && data[4]==data[5] && data[4]==data[6] ) return 1; if ( data[8]!=0 && data[8]==data[9] && data[8]==data[10] ) return 1; if ( data[12]!=0 && data[12]==data[13] && data[12]==data[14] ) return 1; return 0; } int acceptDCW(uint8_t *data) { if (!checksumDCW(data)) return 0; if ( isnullDCW(data) ) return 0; if ( isbadDCW(data) ) return 0; struct dcw_data *dcw = cfg.bad_dcw; while (dcw) { if (!memcmp(dcw->dcw, data, 16)) return 0; dcw = dcw->next; } return 1; }