void TC_Configure(AT91S_TC *pTc, unsigned int mode) { // Disable TC clock pTc->TC_CCR = AT91C_TC_CLKDIS; // Disable interrupts pTc->TC_IDR = 0xFFFFFFFF; // Clear status register pTc->TC_SR; // Set mode pTc->TC_CMR = mode; }