Add anti-chattering function in Contoril Unit