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