void PIT_Init(unsigned int period, unsigned int pit_frequency) { AT91C_BASE_PITC->PITC_PIMR = period? (period * pit_frequency + 8) >> 4 : 0; AT91C_BASE_PITC->PITC_PIMR |= AT91C_PITC_PITEN; }