Ejemplo n.º 1
0
static int smc_remove(struct platform_device *pdev)
{
	smc_dev_t *smc = (smc_dev_t*)dev_get_drvdata(&pdev->dev);
	
	mutex_lock(&smc_lock);
	
	smc_dev_deinit(smc);
	
	mutex_unlock(&smc_lock);
	
	return 0;
}
Ejemplo n.º 2
0
static int smc_remove(struct platform_device *pdev)
{
	smc_dev_t *smc = (smc_dev_t*)dev_get_drvdata(&pdev->dev);
	
	mutex_lock(&smc_lock);
	
	s_smc_task_state = 0;
	kthread_stop(s_smc_task);
	switch_dev_unregister(&sdev);

	smc_dev_deinit(smc);
	
	mutex_unlock(&smc_lock);
	
	return 0;
}
Ejemplo n.º 3
0
static int smc_dev_init(smc_dev_t *smc, int id)
{
	struct resource *res;
	char buf[32];
	struct devio_aml_platform_data *pd_smc;

	smc->id = id;
	
	smc->reset_pin = smc0_reset;
	if(smc->reset_pin==-1) {
		snprintf(buf, sizeof(buf), "smc%d_reset", id);
		res = platform_get_resource_byname(smc->pdev, IORESOURCE_MEM, buf);
		if (!res) {
			pr_error("cannot get resource \"%s\"\n", buf);
		} else {
			smc->reset_pin = res->start;
		}
	}
	
	smc->irq_num = smc0_irq;
	if(smc->irq_num==-1) {
		snprintf(buf, sizeof(buf), "smc%d_irq", id);
		res = platform_get_resource_byname(smc->pdev, IORESOURCE_IRQ, buf);
	if (!res) {
		pr_error("cannot get resource \"%s\"\n", buf);
		return -1;
	}
	smc->irq_num = res->start;
	}
	
	init_waitqueue_head(&smc->rd_wq);
	init_waitqueue_head(&smc->wr_wq);
	spin_lock_init(&smc->slock);
	mutex_init(&smc->lock);
	
	pd_smc =  (struct devio_aml_platform_data*)smc->pdev->dev.platform_data;
	if(pd_smc) {
		if(pd_smc->io_setup)
			pd_smc->io_setup(NULL);

		smc->reset = pd_smc->io_reset;
	}
	
	smc->irq_num=request_irq(smc->irq_num,(irq_handler_t)smc_irq_handler,IRQF_SHARED,"smc",smc);
	if(smc->irq_num<0) {
		pr_error("request irq error!\n");
		smc_dev_deinit(smc);
		return -1;
	}
	
	snprintf(buf, sizeof(buf), "smc%d", smc->id);
	smc->dev=device_create(&smc_class, NULL, MKDEV(smc_major, smc->id), smc, buf);
	if(!smc->dev) {
		pr_error("create device error!\n");
		smc_dev_deinit(smc);
		return -1;
	}

	smc->param.f = F_DEFAULT;
	smc->param.d = D_DEFAULT;
	smc->param.n = N_DEFAULT;
	smc->param.bwi = BWI_DEFAULT;
	smc->param.cwi = CWI_DEFAULT;
	smc->param.bgt = BGT_DEFAULT;
	smc->param.freq = FREQ_DEFAULT;
	smc->param.recv_invert = 0;
	smc->param.recv_lsb_msb = 0;
	smc->param.recv_no_parity = 1;
	smc->param.xmit_invert = 0;
	smc->param.xmit_lsb_msb = 0;
	smc->param.xmit_retries = 1;
	smc->param.xmit_repeat_dis = 1;
	smc->init = 1;

	smc_hw_setup(smc);
	
	return 0;
}