void PMC_DisablePeripheral(unsigned int id) { SANITY_CHECK(id < 32); if ((AT91C_BASE_PMC->PMC_PCSR & (1 << id)) != (1 << id)) { TRACE_INFO("PMC_DisablePeripheral: clock of peripheral" " %u is not enabled\n\r", id); } else { AT91C_BASE_PMC->PMC_PCDR = 1 << id; } }