void initTwi( void ) { /* Define TWD and TWCK as peripherals lines */ pPIOA->PIO_PDR = AT91C_PA11_TWCK | AT91C_PA10_TWD; pPIOA->PIO_ASR = AT91C_PA11_TWCK | AT91C_PA10_TWD; pPIOA->PIO_BSR = 0; /* Enable the clock of the TWI */ pPMC->PMC_PCER = (1U << AT91C_ID_TWI); /* Disable interrupts */ pTWI->TWI_IDR = (unsigned int) -1; /* Reset peripheral */ pTWI->TWI_CR = AT91C_TWI_SWRST; /* Set the TWI clock to 100 KHz */ AT91F_SetTwiClock(); /* Enable TWI controller */ pTWI->TWI_CR = AT91C_TWI_MSEN; }