int __init archos_accel_init(struct mma7660fc_pdata *pdata) { struct archos_accel_conf accel_gpio; const struct archos_accel_config *accel_cfg; accel_cfg = omap_get_config( ARCHOS_TAG_ACCEL, struct archos_accel_config ); if (accel_cfg == NULL) { printk(KERN_DEBUG "archos_accel_init: no board configuration found\n"); return -ENODEV; } if ( hardware_rev >= accel_cfg->nrev ) { printk(KERN_DEBUG "archos_accel_init: hardware_rev (%i) >= nrev (%i)\n", hardware_rev, accel_cfg->nrev); return -ENODEV; } accel_gpio = accel_cfg->rev[hardware_rev]; /* irq needed by the driver */ if (GPIO_PIN( accel_gpio.accel_int1 ) != -1) pdata->irq = gpio_to_irq(GPIO_PIN( accel_gpio.accel_int1 )); else pdata->irq = -1; printk("archos_accel_init: irq %d\n",pdata->irq); archos_gpio_init_input( &accel_gpio.accel_int1, "accel_int1"); return 0; }
int __init archos_audio_gpio_init(void) { const struct archos_audio_config *audio_cfg; struct clk *clkout2_src_ck; struct clk *sys_clkout2; struct clk *core_ck; /* audio */ audio_cfg = omap_get_config( ARCHOS_TAG_AUDIO, struct archos_audio_config ); if (audio_cfg == NULL) { pr_err("archos_audio_gpio_init: no board configuration found\n"); return -ENODEV; } if ( hardware_rev >= audio_cfg->nrev ) { pr_err("archos_audio_gpio_init: hardware_rev (%i) >= nrev (%i)\n", hardware_rev, audio_cfg->nrev); return -ENODEV; } audio_gpio = audio_cfg->rev[hardware_rev]; // a32 & a43 protos where using clkout1. if (hardware_rev >= 1 || !(machine_is_archos_a32() || machine_is_archos_a43())) { core_ck = clk_get(NULL, "cm_96m_fck"); if (IS_ERR(core_ck)) { printk(KERN_ERR "failed to get core_ck\n"); } clkout2_src_ck = clk_get(NULL, "clkout2_src_ck"); if (IS_ERR(clkout2_src_ck)) { printk(KERN_ERR "failed to get clkout2_src_ck\n"); } sys_clkout2 = clk_get(NULL, "sys_clkout2"); if (IS_ERR(sys_clkout2)) { printk(KERN_ERR "failed to get sys_clkout2\n"); } if ( clk_set_parent(clkout2_src_ck, core_ck) != 0) { printk(KERN_ERR "failed to set sys_clkout2 parent to clkout2\n"); } /* Set the clock to 12 Mhz */ omap2_clksel_set_rate(sys_clkout2, 12000000); clk_put(sys_clkout2); clk_put(clkout2_src_ck); clk_put(core_ck); sysclock_name = sys_clkout2_name; use_mcbsp1_fclk = 1; } else { sysclock_name = sys_clkout1_name; } if (GPIO_PIN( audio_gpio.spdif ) != -1) archos_gpio_init_output( &audio_gpio.spdif, "spdif" ); if (GPIO_PIN( audio_gpio.hp_on ) != -1) archos_gpio_init_output( &audio_gpio.hp_on, "hp_on" ); if (GPIO_PIN( audio_gpio.headphone_plugged ) != -1) archos_gpio_init_input( &audio_gpio.headphone_plugged, "hp_detect" ); if (GPIO_PIN( audio_gpio.vamp_vbat ) != -1) archos_gpio_init_output( &audio_gpio.vamp_vbat, "vamp_vbat" ); if (GPIO_PIN( audio_gpio.vamp_dc ) != -1) archos_gpio_init_output( &audio_gpio.vamp_dc, "vamp_dc" ); // XXX maybe prevents OFF mode? if (GPIO_PIN( audio_gpio.headphone_plugged ) != -1) gpio_set_debounce(GPIO_PIN(audio_gpio.headphone_plugged), (1 + 1) * 0x1f); if (GPIO_PIN(audio_gpio.vamp_dc) != -1) { int ret = platform_device_register(&archos_audio_vamp_device); if (ret < 0) return ret; ret = platform_driver_register(&archos_audio_vamp_driver); if (ret < 0) return ret; ret = device_create_file(&archos_audio_vamp_device.dev, &dev_attr_vamp_vusb_ctrl); if (ret < 0) return ret; hrtimer_init(&vamp_watchdog_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); vamp_watchdog_timer.function = vamp_watchdog_timer_func; } pr_debug("%s init done\n", __FUNCTION__); return 0; }