Single 7 bit Parity Bit Correction in C