Remove IDLE gap counter (causing trouble due to overflows)
Use gcc built in parity bit calculation