void __init at91_add_device_spi(struct spi_board_info *devices, int nr_devices)
{
int i;
unsigned long cs_pin;
short enable_spi0 = 0;
short enable_spi1 = 0;

/* Choose SPI chip-selects */
/*for (i = 0; i < nr_devices; i++) {*/
for (i = 0; i < 1; i++) { /* spi1 ne ispolzuem, vivodi pod com-port */
if (devices[i].controller_data)
cs_pin = (unsigned long) devices[i].controller_data;
else if (devices[i].bus_num == 0)
cs_pin = spi0_standard_cs[devices[i].chip_select];
else
cs_pin = spi1_standard_cs[devices[i].chip_select];

if (devices[i].bus_num == 0)
enable_spi0 = 1;
else
enable_spi1 = 1;

/* enable chip-select pin */
at91_set_gpio_output(cs_pin, 1);

/* pass chip-select pin to driver */
devices[i].controller_data = (void *) cs_pin;
}

spi_register_board_info(devices, nr_devices);

/* Configure SPI bus(es) */
if (enable_spi0) {
at91_set_A_periph(AT91_PIN_PB0, 0); /* SPI0_MISO */
at91_set_A_periph(AT91_PIN_PB1, 0); /* SPI0_MOSI */
at91_set_A_periph(AT91_PIN_PB2, 0); /* SPI0_SPCK */

platform_device_register(&at91sam9g45_spi0_device);
}
if (enable_spi1) {
// at91_set_A_periph(AT91_PIN_PB14, 0); /* SPI1_MISO */
// at91_set_A_periph(AT91_PIN_PB15, 0); /* SPI1_MOSI */
// at91_set_A_periph(AT91_PIN_PB16, 0); /* SPI1_SPCK */

// platform_device_register(&at91sam9g45_spi1_device);
}
}

static inline void configure_usart0_pins(unsigned pins)
{
at91_set_A_periph(AT91_PIN_PB19, 1); /* TXD0 */
at91_set_A_periph(AT91_PIN_PB18, 0); /* RXD0 */

if (pins & ATMEL_UART_RTS)
at91_set_B_periph(AT91_PIN_PB17, 0); /* RTS0 */
if (pins & ATMEL_UART_CTS)
at91_set_B_periph(AT91_PIN_PB15, 0); /* CTS0 */
}