void __init stx7105_configure_lirc(struct stx7105_lirc_config *config)
{
static int configured;
struct stx7105_lirc_config default_config = {};
struct stm_plat_lirc_data *plat_data =
stx7105_lirc_device.dev.platform_data;
struct stm_pad_config *pad_config;
BUG_ON(configured);
configured = 1;
if (!config)
config = &default_config;
pad_config = stm_pad_config_alloc(3, 0);
BUG_ON(!pad_config);
plat_data->txenabled = config->tx_enabled || config->tx_od_enabled;
plat_data->pads = pad_config;
switch (config->rx_mode) {
case stx7105_lirc_rx_disabled:
/* Nothing to do */
break;
case stx7105_lirc_rx_mode_ir:
plat_data->rxuhfmode = 0;
stm_pad_config_add_pio_in(pad_config, 3, 0, -1);
break;
case stx7105_lirc_rx_mode_uhf:
plat_data->rxuhfmode = 1;
stm_pad_config_add_pio_in(pad_config, 3, 1, -1);
break;
default:
BUG();
break;
}
if (config->tx_enabled)
stm_pad_config_add_pio_out(pad_config, 3, 2, 3);
if (config->tx_od_enabled)
stm_pad_config_add_pio_out(pad_config, 3, 3, 3);
platform_device_register(&stx7105_lirc_device);
}
int __init stx7105_configure_ssc_spi(int ssc, struct stx7105_ssc_config *config)
{
static int spi_busnum;
struct stx7105_ssc_config default_config = {};
struct stm_plat_ssc_data *plat_data;
struct stm_pad_config *pad_config;
BUG_ON(ssc < 0 || ssc >= ARRAY_SIZE(stx7105_ssc_devices));
BUG_ON(stx7105_ssc_configured[ssc]);
stx7105_ssc_configured[ssc] = 1;
if (!config)
config = &default_config;
stx7105_ssc_devices[ssc].name = "spi-stm";
stx7105_ssc_devices[ssc].id = spi_busnum;
plat_data = stx7105_ssc_devices[ssc].dev.platform_data;
switch (ssc) {
case 0:
case 1:
pad_config = &stx7105_ssc_spi_pad_configs[ssc];
break;
case 2:
pad_config = stm_pad_config_alloc(3, 2);
/* SCK */
switch (config->routing.ssc2.sclk) {
case stx7105_ssc2_sclk_pio2_4: /* 7106 only! */
BUG_ON(cpu_data->type != CPU_STX7106);
stm_pad_config_add_pio_out(pad_config, 2, 4, 2);
/* ssc2_sclk_in: 00 = PIO2.4 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 0);
break;
case stx7105_ssc2_sclk_pio3_4:
stm_pad_config_add_pio_out(pad_config, 3, 4, 2);
/* ssc2_sclk_in: 01 = PIO3.4 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 1);
break;
case stx7105_ssc2_sclk_pio12_0:
stm_pad_config_add_pio_out(pad_config, 12, 0, 3);
/* ssc2_sclk_in: 10 = PIO12.0 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 2);
break;
case stx7105_ssc2_sclk_pio13_4:
stm_pad_config_add_pio_out(pad_config, 13, 4, 2);
/* ssc2_sclk_in: 11 = PIO13.4 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 3);
break;
}
/* MOSI */
switch (config->routing.ssc2.mtsr) {
case stx7105_ssc2_mtsr_pio2_0:
stm_pad_config_add_pio_out(pad_config, 2, 0, 3);
break;
case stx7105_ssc2_mtsr_pio3_5:
stm_pad_config_add_pio_out(pad_config, 3, 5, 2);
break;
case stx7105_ssc2_mtsr_pio12_1:
stm_pad_config_add_pio_out(pad_config, 12, 1, 3);
break;
case stx7105_ssc2_mtsr_pio13_5:
stm_pad_config_add_pio_out(pad_config, 13, 5, 2);
break;
}
/* MISO */
switch (config->routing.ssc2.mrst) {
case stx7105_ssc2_mrst_pio2_0:
stm_pad_config_add_pio_in(pad_config, 2, 0, -1);
/* ssc2_mrst_in: 00 = PIO2.0 */
stm_pad_config_add_sys_cfg(pad_config, 16, 7, 8, 0);
break;
case stx7105_ssc2_mrst_pio3_5:
stm_pad_config_add_pio_in(pad_config, 3, 5, -1);
/* ssc2_mrst_in: 01 = PIO3.5 */
stm_pad_config_add_sys_cfg(pad_config, 16, 7, 8, 1);
break;
case stx7105_ssc2_mrst_pio12_1:
stm_pad_config_add_pio_in(pad_config, 12, 1, -1);
/* ssc2_mrst_in: 10 = PIO12.1 */
stm_pad_config_add_sys_cfg(pad_config, 16, 7, 8, 2);
break;
case stx7105_ssc2_mrst_pio13_5:
stm_pad_config_add_pio_in(pad_config, 13, 5, -1);
/* ssc2_mrst_in: 11 = PIO13.5 */
stm_pad_config_add_sys_cfg(pad_config, 16, 7, 8, 3);
break;
}
break;
case 3:
pad_config = stm_pad_config_alloc(3, 2);
/* SCK */
switch (config->routing.ssc3.sclk) {
case stx7105_ssc3_sclk_pio2_7: /* 7106 only! */
BUG_ON(cpu_data->type != CPU_STX7106);
stm_pad_config_add_pio_out(pad_config, 2, 7, 2);
/* ssc3_sclk_in: 00 = PIO2.7 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 0);
break;
case stx7105_ssc3_sclk_pio3_6:
stm_pad_config_add_pio_out(pad_config, 3, 6, 2);
/* ssc3_sclk_in: 00 = PIO3.6 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 0);
break;
case stx7105_ssc3_sclk_pio13_2:
stm_pad_config_add_pio_out(pad_config, 13, 2, 4);
/* ssc3_sclk_in: 01 = PIO13.2 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 1);
break;
case stx7105_ssc3_sclk_pio13_6:
stm_pad_config_add_pio_out(pad_config, 13, 6, 2);
/* ssc3_sclk_in: 1x = PIO13.6 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 2);
break;
}
/* MOSI */
switch (config->routing.ssc3.mtsr) {
case stx7105_ssc3_mtsr_pio2_1:
stm_pad_config_add_pio_out(pad_config, 2, 1, 3);
break;
case stx7105_ssc3_mtsr_pio3_7:
stm_pad_config_add_pio_out(pad_config, 3, 7, 3);
break;
case stx7105_ssc3_mtsr_pio13_3:
stm_pad_config_add_pio_out(pad_config, 13, 3, 4);
break;
case stx7105_ssc3_mtsr_pio13_7:
stm_pad_config_add_pio_out(pad_config, 13, 7, 2);
break;
}
/* MISO */
switch (config->routing.ssc3.mrst) {
case stx7105_ssc3_mrst_pio2_1:
stm_pad_config_add_pio_in(pad_config, 2, 1, -1);
/* ssc3_mrst_in: 00 = PIO2.1 */
stm_pad_config_add_sys_cfg(pad_config, 16, 14, 15, 0);
break;
case stx7105_ssc3_mrst_pio3_7:
stm_pad_config_add_pio_in(pad_config, 3, 7, -1);
/* ssc3_mrst_in: 01 = PIO3.7 */
stm_pad_config_add_sys_cfg(pad_config, 16, 14, 15, 1);
break;
case stx7105_ssc3_mrst_pio13_3:
stm_pad_config_add_pio_in(pad_config, 13, 3, -1);
/* ssc3_mrst_in: 10 = PIO13.3 */
stm_pad_config_add_sys_cfg(pad_config, 16, 14, 15, 2);
break;
case stx7105_ssc3_mrst_pio13_7:
stm_pad_config_add_pio_in(pad_config, 13, 7, -1);
/* ssc3_mrst_in: 11 = PIO13.7 */
stm_pad_config_add_sys_cfg(pad_config, 16, 14, 15, 3);
break;
}
break;
default:
BUG();
pad_config = NULL; /* Keep the compiler happy ;-) */
break;
}
plat_data->spi_chipselect = config->spi_chipselect;
plat_data->pad_config = pad_config;
platform_device_register(&stx7105_ssc_devices[ssc]);
return spi_busnum++;
}
int __init stx7105_configure_ssc_i2c(int ssc, struct stx7105_ssc_config *config)
{
static int i2c_busnum;
struct stx7105_ssc_config default_config = {};
struct stm_plat_ssc_data *plat_data;
struct stm_pad_config *pad_config;
BUG_ON(ssc < 0 || ssc >= ARRAY_SIZE(stx7105_ssc_devices));
BUG_ON(stx7105_ssc_configured[ssc]);
stx7105_ssc_configured[ssc] = 1;
if (!config)
config = &default_config;
stx7105_ssc_devices[ssc].name = "i2c-stm";
stx7105_ssc_devices[ssc].id = i2c_busnum;
plat_data = stx7105_ssc_devices[ssc].dev.platform_data;
switch (ssc) {
case 0:
case 1:
pad_config = &stx7105_ssc_i2c_pad_configs[ssc];
break;
case 2:
pad_config = stm_pad_config_alloc(2, 2);
/* SCL */
switch (config->routing.ssc2.sclk) {
case stx7105_ssc2_sclk_pio2_4: /* 7106 only! */
BUG_ON(cpu_data->type != CPU_STX7106);
stm_pad_config_add_pio_bidir_named(pad_config,
2, 4, 2, "SCL");
/* ssc2_sclk_in: 00 = PIO2.4 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 0);
break;
case stx7105_ssc2_sclk_pio3_4:
stm_pad_config_add_pio_bidir_named(pad_config,
3, 4, 2, "SCL");
/* ssc2_sclk_in: 01 = PIO3.4 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 1);
break;
case stx7105_ssc2_sclk_pio12_0:
stm_pad_config_add_pio_bidir_named(pad_config,
12, 0, 3, "SCL");
/* ssc2_sclk_in: 10 = PIO12.0 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 2);
break;
case stx7105_ssc2_sclk_pio13_4:
stm_pad_config_add_pio_bidir_named(pad_config,
13, 4, 2, "SCL");
/* ssc2_sclk_in: 11 = PIO13.4 */
stm_pad_config_add_sys_cfg(pad_config, 16, 11, 12, 3);
break;
}
/* SDA */
switch (config->routing.ssc2.mtsr) {
case stx7105_ssc2_mtsr_pio2_0:
stm_pad_config_add_pio_bidir_named(pad_config,
2, 0, 3, "SDA");
/* ssc2_mtsr_in: 00 = PIO2.0 */
stm_pad_config_add_sys_cfg(pad_config, 16, 9, 10, 0);
break;
case stx7105_ssc2_mtsr_pio3_5:
stm_pad_config_add_pio_bidir_named(pad_config,
3, 5, 2, "SDA");
/* ssc2_mtsr_in: 01 = PIO3.5 */
stm_pad_config_add_sys_cfg(pad_config, 16, 9, 10, 1);
break;
case stx7105_ssc2_mtsr_pio12_1:
stm_pad_config_add_pio_bidir_named(pad_config,
12, 1, 3, "SDA");
/* ssc2_mtsr_in: 10 = PIO12.1 */
stm_pad_config_add_sys_cfg(pad_config, 16, 9, 10, 2);
break;
case stx7105_ssc2_mtsr_pio13_5:
stm_pad_config_add_pio_bidir_named(pad_config,
13, 5, 2, "SDA");
/* ssc2_mtsr_in: 11 = PIO13.5 */
stm_pad_config_add_sys_cfg(pad_config, 16, 9, 10, 3);
break;
}
break;
case 3:
pad_config = stm_pad_config_alloc(2, 2);
/* SCL */
switch (config->routing.ssc3.sclk) {
case stx7105_ssc3_sclk_pio2_7: /* 7106 only! */
BUG_ON(cpu_data->type != CPU_STX7106);
stm_pad_config_add_pio_bidir_named(pad_config,
2, 7, 2, "SCL");
/* ssc3_sclk_in: 00 = PIO2.7 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 0);
break;
case stx7105_ssc3_sclk_pio3_6:
stm_pad_config_add_pio_bidir_named(pad_config,
3, 6, 2, "SCL");
/* ssc3_sclk_in: 01 = PIO3.6 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 1);
break;
case stx7105_ssc3_sclk_pio13_2:
stm_pad_config_add_pio_bidir_named(pad_config,
13, 2, 4, "SCL");
/* ssc3_sclk_in: 10 = PIO13.2 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 2);
break;
case stx7105_ssc3_sclk_pio13_6:
stm_pad_config_add_pio_bidir_named(pad_config,
13, 6, 2, "SCL");
/* ssc3_sclk_in: 11 = PIO13.6 */
stm_pad_config_add_sys_cfg(pad_config, 16, 18, 19, 3);
break;
}
/* SDA */
switch (config->routing.ssc3.mtsr) {
case stx7105_ssc3_mtsr_pio2_1:
stm_pad_config_add_pio_bidir_named(pad_config,
2, 1, 3, "SDA");
/* ssc3_mtsr_in: 00 = PIO2.1 */
stm_pad_config_add_sys_cfg(pad_config, 16, 16, 17, 0);
break;
case stx7105_ssc3_mtsr_pio3_7:
stm_pad_config_add_pio_bidir_named(pad_config,
3, 7, 2, "SDA");
/* ssc3_mtsr_in: 01 = PIO3.7 */
stm_pad_config_add_sys_cfg(pad_config, 16, 16, 17, 1);
break;
case stx7105_ssc3_mtsr_pio13_3:
stm_pad_config_add_pio_bidir_named(pad_config,
13, 3, 4, "SDA");
/* ssc3_mtsr_in: 10 = PIO13.3 */
stm_pad_config_add_sys_cfg(pad_config, 16, 16, 17, 2);
break;
case stx7105_ssc3_mtsr_pio13_7:
stm_pad_config_add_pio_bidir_named(pad_config,
13, 7, 2, "SDA");
/* ssc3_mtsr_in: 11 = PIO13.7 */
stm_pad_config_add_sys_cfg(pad_config, 16, 16, 17, 3);
break;
}
break;
default:
BUG();
pad_config = NULL; /* Keep the compiler happy ;-) */
break;
}
plat_data->pad_config = pad_config;
/* I2C bus number reservation (to prevent any hot-plug device
* from using it) */
i2c_register_board_info(i2c_busnum, NULL, 0);
platform_device_register(&stx7105_ssc_devices[ssc]);
return i2c_busnum++;
}
int __init stx7108_configure_ssc_spi(int ssc, struct stx7108_ssc_config *config)
{
static int spi_busnum;
struct stx7108_ssc_config default_config = {};
struct stm_plat_ssc_data *plat_data;
struct stm_pad_config *pad_config;
BUG_ON(ssc < 0 || ssc >= ARRAY_SIZE(stx7108_ssc_devices));
BUG_ON(stx7108_ssc_configured[ssc]);
stx7108_ssc_configured[ssc] = 1;
if (!config)
config = &default_config;
stx7108_ssc_devices[ssc].name = "spi-stm";
stx7108_ssc_devices[ssc].id = spi_busnum;
plat_data = stx7108_ssc_devices[ssc].dev.platform_data;
if (ssc == 2) {
pad_config = stm_pad_config_alloc(3, 0);
/* SCK */
switch (config->routing.ssc2.sclk) {
case stx7108_ssc2_sclk_pio1_3:
stm_pad_config_add_pio_bidir_named(pad_config,
1, 3, 2, "SCL");
break;
case stx7108_ssc2_sclk_pio14_4:
stm_pad_config_add_pio_bidir_named(pad_config,
14, 4, 2, "SCL");
break;
default:
BUG();
break;
}
/* MOSI */
switch (config->routing.ssc2.mtsr) {
case stx7108_ssc2_mtsr_pio1_4:
stm_pad_config_add_pio_bidir_named(pad_config,
1, 4, 2, "SDA");
break;
case stx7108_ssc2_mtsr_pio14_5:
stm_pad_config_add_pio_bidir_named(pad_config,
14, 5, 2, "SDA");
break;
default:
BUG();
break;
}
/* MISO */
switch (config->routing.ssc2.mrst) {
case stx7108_ssc2_mrst_pio1_5:
stm_pad_config_add_pio_bidir_named(pad_config,
1, 5, 2, "SDA");
break;
case stx7108_ssc2_mrst_pio14_6:
stm_pad_config_add_pio_bidir_named(pad_config,
14, 6, 2, "SDA");
break;
default:
BUG();
break;
}
} else {
pad_config = &stx7108_ssc_spi_pad_configs[ssc];
}
plat_data->spi_chipselect = config->spi_chipselect;
plat_data->pad_config = pad_config;
platform_device_register(&stx7108_ssc_devices[ssc]);
return spi_busnum++;
}
int __init stx7108_configure_ssc_i2c(int ssc, struct stx7108_ssc_config *config)
{
static int i2c_busnum;
struct stx7108_ssc_config default_config = {};
struct stm_plat_ssc_data *plat_data;
struct stm_pad_config *pad_config;
BUG_ON(ssc < 0 || ssc >= ARRAY_SIZE(stx7108_ssc_devices));
BUG_ON(stx7108_ssc_configured[ssc]);
stx7108_ssc_configured[ssc] = 1;
if (!config)
config = &default_config;
stx7108_ssc_devices[ssc].name = "i2c-stm";
stx7108_ssc_devices[ssc].id = i2c_busnum;
plat_data = stx7108_ssc_devices[ssc].dev.platform_data;
if (ssc == 2) {
pad_config = stm_pad_config_alloc(2, 0);
/* SCL */
switch (config->routing.ssc2.sclk) {
case stx7108_ssc2_sclk_pio1_3:
stm_pad_config_add_pio_bidir_named(pad_config,
1, 3, 2, "SCL");
break;
case stx7108_ssc2_sclk_pio14_4:
stm_pad_config_add_pio_bidir_named(pad_config,
14, 4, 2, "SCL");
break;
default:
BUG();
break;
}
/* SDA */
switch (config->routing.ssc2.mtsr) {
case stx7108_ssc2_mtsr_pio1_4:
stm_pad_config_add_pio_bidir_named(pad_config,
1, 4, 2, "SDA");
break;
case stx7108_ssc2_mtsr_pio14_5:
stm_pad_config_add_pio_bidir_named(pad_config,
14, 5, 2, "SDA");
break;
default:
BUG();
break;
}
} else {
pad_config = &stx7108_ssc_i2c_pad_configs[ssc];
}
plat_data->pad_config = pad_config;
plat_data->i2c_fastmode = config->i2c_fastmode;
/* I2C bus number reservation (to prevent any hot-plug device
* from using it) */
i2c_register_board_info(i2c_busnum, NULL, 0);
platform_device_register(&stx7108_ssc_devices[ssc]);
return i2c_busnum++;
}
void __init stx7108_configure_asc(int asc, struct stx7108_asc_config *config)
{
static int configured[ARRAY_SIZE(stx7108_asc_devices)];
static int tty_id;
struct stx7108_asc_config default_config = {};
struct platform_device *pdev;
struct stm_plat_asc_data *plat_data;
struct stm_pad_config *pad_config;
BUG_ON(asc < 0 || asc >= ARRAY_SIZE(stx7108_asc_devices));
BUG_ON(configured[asc]);
configured[asc] = 1;
if (!config)
config = &default_config;
pdev = &stx7108_asc_devices[asc];
plat_data = pdev->dev.platform_data;
pdev->id = tty_id++;
plat_data->hw_flow_control = config->hw_flow_control;
plat_data->txfifo_bug = 1;
if (asc == 3) {
pad_config = stm_pad_config_alloc(4, 0);
plat_data->pad_config = pad_config;
switch (config->routing.asc3.txd) {
case stx7108_asc3_txd_pio21_0:
stm_pad_config_add_pio_out(pad_config, 21, 0, 2);
break;
case stx7108_asc3_txd_pio24_4:
stm_pad_config_add_pio_out(pad_config, 24, 4, 1);
break;
default:
BUG();
break;
}
switch (config->routing.asc3.rxd) {
case stx7108_asc3_rxd_pio21_1:
stm_pad_config_add_pio_in(pad_config, 21, 1, 2);
break;
case stx7108_asc3_rxd_pio24_5:
stm_pad_config_add_pio_in(pad_config, 24, 5, 1);
break;
default:
BUG();
break;
}
if (config->hw_flow_control) {
switch (config->routing.asc3.cts) {
case stx7108_asc3_cts_pio21_4:
stm_pad_config_add_pio_in(pad_config, 21, 4, 2);
break;
case stx7108_asc3_cts_pio25_0:
stm_pad_config_add_pio_in(pad_config, 25, 0, 1);
break;
default:
BUG();
break;
}
switch (config->routing.asc3.rts) {
case stx7108_asc3_rts_pio21_3:
stm_pad_config_add_pio_out(pad_config,
21, 3, 2);
break;
case stx7108_asc3_rts_pio24_7:
stm_pad_config_add_pio_out(pad_config,
24, 7, 1);
break;
default:
BUG();
break;
}
}
} else {
pad_config = &stx7108_asc_pad_configs[asc];
if (!config->hw_flow_control) {
/* Don't claim RTS/CTS pads */
stm_pad_set_pio_ignored(pad_config, "RTS");
stm_pad_set_pio_ignored(pad_config, "CTS");
}
}
if (config->is_console)
stm_asc_console_device = pdev->id;
stm_asc_configured_devices[stm_asc_configured_devices_num++] = pdev;
}
