自学教程：C++ ucb1400_reg_write函数代码示例

static void ucb1400_clear_pending_irq(struct ucb1400_ts *ucb){	unsigned int isr;	isr = ucb1400_reg_read(ucb->ac97, UCB_IE_STATUS);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, isr);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0);	if (isr & UCB_IE_TSPX)		ucb1400_ts_irq_disable(ucb);	else		dev_dbg(&ucb->ts_idev->dev,			"ucb1400: unexpected IE_STATUS = %#x/n", isr);}

static void ucb1400_handle_pending_irq(struct ucb1400_ts *ucb){    unsigned int isr;    isr = ucb1400_reg_read(ucb->ac97, UCB_IE_STATUS);    ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, isr);    ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0);    if (isr & UCB_IE_TSPX) {        ucb1400_ts_irq_disable(ucb->ac97);        enable_irq(ucb->irq);    } else        printk(KERN_ERR "ucb1400: unexpected IE_STATUS = %#x/n", isr);}

/* Switch to interrupt mode. */static inline void ucb1400_ts_mode_int(struct snd_ac97 *ac97){    ucb1400_reg_write(ac97, UCB_TS_CR,                      UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |                      UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |                      UCB_TS_CR_MODE_INT);}

/* Switch to interrupt mode. */static void ucb1400_ts_mode_int(struct ucb1400_ts *ucb){	ucb1400_reg_write(ucb->ac97, UCB_TS_CR,			UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |			UCB_TS_CR_MODE_INT);}

/* * Switch to X position mode and measure Y plate.  We switch the plate * configuration in pressure mode, then switch to position mode.  This * gives a faster response time.  Even so, we need to wait about 55us * for things to stabilise. */static inline unsigned int ucb1400_ts_read_xpos(struct ucb1400_ts *ucb){    ucb1400_reg_write(ucb->ac97, UCB_TS_CR,                      UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |                      UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);    ucb1400_reg_write(ucb->ac97, UCB_TS_CR,                      UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |                      UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);    ucb1400_reg_write(ucb->ac97, UCB_TS_CR,                      UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |                      UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);    udelay(ts_delay);    return ucb1400_adc_read(ucb->ac97, UCB_ADC_INP_TSPY, adcsync);}

/* Switch to interrupt mode. */static inline void ucb1400_ts_mode_int(struct ucb1400 *ucb){	ucb1400_reg_write(ucb, UCB_TS_CR,			UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |			UCB_TS_CR_MODE_INT);}

/* * Switch to Y position mode and measure X plate.  We switch the plate * configuration in pressure mode, then switch to position mode.  This * gives a faster response time.  Even so, we need to wait about 55us * for things to stabilise. */static inline unsigned int ucb1400_ts_read_ypos(struct ucb1400 *ucb){	ucb1400_reg_write(ucb, UCB_TS_CR,			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |			UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);	ucb1400_reg_write(ucb, UCB_TS_CR,			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |			UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);	ucb1400_reg_write(ucb, UCB_TS_CR,			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |			UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);	udelay(ts_delay);	return ucb1400_adc_read(ucb, UCB_ADC_INP_TSPX);}

/* * Switch to Y plate resistance mode.  Set MY to ground, PY to * supply.  Measure current. */static inline unsigned int ucb1400_ts_read_yres(struct ucb1400 *ucb){	ucb1400_reg_write(ucb, UCB_TS_CR,			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |			UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);	return ucb1400_adc_read(ucb, 0);}

/* * Switch to X plate resistance mode.  Set MX to ground, PX to * supply.  Measure current. */static inline unsigned int ucb1400_ts_read_xres(struct ucb1400_ts *ucb){    ucb1400_reg_write(ucb->ac97, UCB_TS_CR,                      UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |                      UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);    return ucb1400_adc_read(ucb->ac97, 0, adcsync);}

unsigned int ucb1400_adc_read(struct snd_ac97 *ac97, u16 adc_channel,		int adcsync){	unsigned int val;	if (adcsync)		adc_channel |= UCB_ADC_SYNC_ENA;	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel);	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel |			UCB_ADC_START);	while (!((val = ucb1400_reg_read(ac97, UCB_ADC_DATA))				& UCB_ADC_DAT_VALID))		schedule_timeout_uninterruptible(1);	return val & UCB_ADC_DAT_MASK;}

/* * Switch to pressure mode, and read pressure.  We don't need to wait * here, since both plates are being driven. */static unsigned int ucb1400_ts_read_pressure(struct ucb1400_ts *ucb){	ucb1400_reg_write(ucb->ac97, UCB_TS_CR,			UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |			UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |			UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);	udelay(ts_delay_pressure);	return ucb1400_adc_read(ucb->ac97, UCB_ADC_INP_TSPY, adcsync);}

static void ucb1400_ts_stop(struct ucb1400_ts *ucb){	/* Signal IRQ thread to stop polling and disable the handler. */	ucb->stopped = true;	mb();	wake_up(&ucb->ts_wait);	disable_irq(ucb->irq);	ucb1400_ts_irq_disable(ucb);	ucb1400_reg_write(ucb->ac97, UCB_TS_CR, 0);}

static unsigned int ucb1400_adc_read(struct ucb1400 *ucb, u16 adc_channel){	unsigned int val;	if (ucb->adcsync)		adc_channel |= UCB_ADC_SYNC_ENA;	ucb1400_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA | adc_channel);	ucb1400_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA | adc_channel | UCB_ADC_START);	for (;;) {		val = ucb1400_reg_read(ucb, UCB_ADC_DATA);		if (val & UCB_ADC_DAT_VALID)			break;		/* yield to other processes */		schedule_timeout_uninterruptible(1);	}	return UCB_ADC_DAT_VALUE(val);}

static void ucb1400_ts_irq_enable(struct ucb1400_ts *ucb){	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, UCB_IE_TSPX);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0);	ucb1400_reg_write(ucb->ac97, UCB_IE_FAL, UCB_IE_TSPX);}

static inline void ucb1400_ts_irq_enable(struct ucb1400 *ucb){	ucb1400_reg_write(ucb, UCB_IE_CLEAR, UCB_IE_TSPX);	ucb1400_reg_write(ucb, UCB_IE_CLEAR, 0);	ucb1400_reg_write(ucb, UCB_IE_FAL, UCB_IE_TSPX);}

/* * Try to probe our interrupt, rather than relying on lots of * hard-coded machine dependencies. */static int ucb1400_ts_detect_irq(struct ucb1400_ts *ucb,					   struct platform_device *pdev){	unsigned long mask, timeout;	mask = probe_irq_on();	/* Enable the ADC interrupt. */	ucb1400_reg_write(ucb->ac97, UCB_IE_RIS, UCB_IE_ADC);	ucb1400_reg_write(ucb->ac97, UCB_IE_FAL, UCB_IE_ADC);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0xffff);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0);	/* Cause an ADC interrupt. */	ucb1400_reg_write(ucb->ac97, UCB_ADC_CR, UCB_ADC_ENA);	ucb1400_reg_write(ucb->ac97, UCB_ADC_CR, UCB_ADC_ENA | UCB_ADC_START);	/* Wait for the conversion to complete. */	timeout = jiffies + HZ/2;	while (!(ucb1400_reg_read(ucb->ac97, UCB_ADC_DATA) &						UCB_ADC_DAT_VALID)) {		cpu_relax();		if (time_after(jiffies, timeout)) {			dev_err(&pdev->dev, "timed out in IRQ probe/n");			probe_irq_off(mask);			return -ENODEV;		}	}	ucb1400_reg_write(ucb->ac97, UCB_ADC_CR, 0);	/* Disable and clear interrupt. */	ucb1400_reg_write(ucb->ac97, UCB_IE_RIS, 0);	ucb1400_reg_write(ucb->ac97, UCB_IE_FAL, 0);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0xffff);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0);	/* Read triggered interrupt. */	ucb->irq = probe_irq_off(mask);	if (ucb->irq < 0 || ucb->irq == NO_IRQ)		return -ENODEV;	return 0;}

static void ucb1400_ts_irq_disable(struct ucb1400_ts *ucb){	ucb1400_reg_write(ucb->ac97, UCB_IE_FAL, 0);}

static inline void ucb1400_adc_enable(struct ucb1400 *ucb){	ucb1400_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA);}

static inline void ucb1400_adc_disable(struct ucb1400 *ucb){	ucb1400_reg_write(ucb, UCB_ADC_CR, 0);}

static int ucb1400_ts_probe(struct platform_device *pdev){	struct ucb1400_ts *ucb = dev_get_platdata(&pdev->dev);	int error, x_res, y_res;	u16 fcsr;	ucb->ts_idev = input_allocate_device();	if (!ucb->ts_idev) {		error = -ENOMEM;		goto err;	}	/* Only in case the IRQ line wasn't supplied, try detecting it */	if (ucb->irq < 0) {		error = ucb1400_ts_detect_irq(ucb, pdev);		if (error) {			dev_err(&pdev->dev, "IRQ probe failed/n");			goto err_free_devs;		}	}	dev_dbg(&pdev->dev, "found IRQ %d/n", ucb->irq);	init_waitqueue_head(&ucb->ts_wait);	input_set_drvdata(ucb->ts_idev, ucb);	ucb->ts_idev->dev.parent	= &pdev->dev;	ucb->ts_idev->name		= "UCB1400 touchscreen interface";	ucb->ts_idev->id.vendor		= ucb1400_reg_read(ucb->ac97,						AC97_VENDOR_ID1);	ucb->ts_idev->id.product	= ucb->id;	ucb->ts_idev->open		= ucb1400_ts_open;	ucb->ts_idev->close		= ucb1400_ts_close;	ucb->ts_idev->evbit[0]		= BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);	ucb->ts_idev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);	/*	 * Enable ADC filter to prevent horrible jitter on Colibri.	 * This also further reduces jitter on boards where ADCSYNC	 * pin is connected.	 */	fcsr = ucb1400_reg_read(ucb->ac97, UCB_FCSR);	ucb1400_reg_write(ucb->ac97, UCB_FCSR, fcsr | UCB_FCSR_AVE);	ucb1400_adc_enable(ucb->ac97);	x_res = ucb1400_ts_read_xres(ucb);	y_res = ucb1400_ts_read_yres(ucb);	ucb1400_adc_disable(ucb->ac97);	dev_dbg(&pdev->dev, "x/y = %d/%d/n", x_res, y_res);	input_set_abs_params(ucb->ts_idev, ABS_X, 0, x_res, 0, 0);	input_set_abs_params(ucb->ts_idev, ABS_Y, 0, y_res, 0, 0);	input_set_abs_params(ucb->ts_idev, ABS_PRESSURE, 0, 0, 0, 0);	ucb1400_ts_stop(ucb);	error = request_threaded_irq(ucb->irq, NULL, ucb1400_irq,				     IRQF_TRIGGER_RISING | IRQF_ONESHOT,				     "UCB1400", ucb);	if (error) {		dev_err(&pdev->dev,			"unable to grab irq%d: %d/n", ucb->irq, error);		goto err_free_devs;	}	error = input_register_device(ucb->ts_idev);	if (error)		goto err_free_irq;	return 0;err_free_irq:	free_irq(ucb->irq, ucb);err_free_devs:	input_free_device(ucb->ts_idev);err:	return error;}

static int ucb1400_ts_probe(struct platform_device *dev){	int error, x_res, y_res;	u16 fcsr;	struct ucb1400_ts *ucb = dev->dev.platform_data;	ucb->ts_idev = input_allocate_device();	if (!ucb->ts_idev) {		error = -ENOMEM;		goto err;	}	error = ucb1400_ts_detect_irq(ucb);	if (error) {		printk(KERN_ERR "UCB1400: IRQ probe failed/n");		goto err_free_devs;	}	init_waitqueue_head(&ucb->ts_wait);	error = request_irq(ucb->irq, ucb1400_hard_irq, IRQF_TRIGGER_RISING,				"UCB1400", ucb);	if (error) {		printk(KERN_ERR "ucb1400: unable to grab irq%d: %d/n",				ucb->irq, error);		goto err_free_devs;	}	printk(KERN_DEBUG "UCB1400: found IRQ %d/n", ucb->irq);	input_set_drvdata(ucb->ts_idev, ucb);	ucb->ts_idev->dev.parent	= &dev->dev;	ucb->ts_idev->name		= "UCB1400 touchscreen interface";	ucb->ts_idev->id.vendor		= ucb1400_reg_read(ucb->ac97,						AC97_VENDOR_ID1);	ucb->ts_idev->id.product	= ucb->id;	ucb->ts_idev->open		= ucb1400_ts_open;	ucb->ts_idev->close		= ucb1400_ts_close;	ucb->ts_idev->evbit[0]		= BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);	ucb->ts_idev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);	/*	 * Enable ADC filter to prevent horrible jitter on Colibri.	 * This also further reduces jitter on boards where ADCSYNC	 * pin is connected.	 */	fcsr = ucb1400_reg_read(ucb->ac97, UCB_FCSR);	ucb1400_reg_write(ucb->ac97, UCB_FCSR, fcsr | UCB_FCSR_AVE);	ucb1400_adc_enable(ucb->ac97);	x_res = ucb1400_ts_read_xres(ucb);	y_res = ucb1400_ts_read_yres(ucb);	ucb1400_adc_disable(ucb->ac97);	printk(KERN_DEBUG "UCB1400: x/y = %d/%d/n", x_res, y_res);	input_set_abs_params(ucb->ts_idev, ABS_X, 0, x_res, 0, 0);	input_set_abs_params(ucb->ts_idev, ABS_Y, 0, y_res, 0, 0);	input_set_abs_params(ucb->ts_idev, ABS_PRESSURE, 0, 0, 0, 0);	error = input_register_device(ucb->ts_idev);	if (error)		goto err_free_irq;	return 0;err_free_irq:	free_irq(ucb->irq, ucb);err_free_devs:	input_free_device(ucb->ts_idev);err:	return error;}

static inline void ucb1400_ts_irq_disable(struct ucb1400 *ucb){	ucb1400_reg_write(ucb, UCB_IE_FAL, 0);}

static inline void ucb1400_ts_irq_disable(struct snd_ac97 *ac97){    ucb1400_reg_write(ac97, UCB_IE_FAL, 0);}

//.........这里部分代码省略.........		wait_event_freezable_timeout(ucb->ts_wait,			ucb->irq_pending || ucb->ts_restart ||			kthread_should_stop(), timeout);	}	/* Send the "pen off" if we are stopping with the pen still active */	if (valid)		ucb1400_ts_event_release(ucb->ts_idev);	ucb->ts_task = NULL;	return 0;}static irqreturn_t ucb1400_hard_irq(int irqnr, void *devid){	struct ucb1400_ts *ucb = devid;	if (irqnr == ucb->irq) {		disable_irq_nosync(ucb->irq);		ucb->irq_pending = 1;		wake_up(&ucb->ts_wait);		return IRQ_HANDLED;	}	return IRQ_NONE;}static int ucb1400_ts_open(struct input_dev *idev){	struct ucb1400_ts *ucb = input_get_drvdata(idev);	int ret = 0;	BUG_ON(ucb->ts_task);	ucb->ts_task = kthread_run(ucb1400_ts_thread, ucb, "UCB1400_ts");	if (IS_ERR(ucb->ts_task)) {		ret = PTR_ERR(ucb->ts_task);		ucb->ts_task = NULL;	}	return ret;}static void ucb1400_ts_close(struct input_dev *idev){	struct ucb1400_ts *ucb = input_get_drvdata(idev);	if (ucb->ts_task)		kthread_stop(ucb->ts_task);	ucb1400_ts_irq_disable(ucb->ac97);	ucb1400_reg_write(ucb->ac97, UCB_TS_CR, 0);}#ifndef NO_IRQ#define NO_IRQ	0#endifstatic int ucb1400_ts_detect_irq(struct ucb1400_ts *ucb){	unsigned long mask, timeout;	mask = probe_irq_on();	/* Enable the ADC interrupt. */	ucb1400_reg_write(ucb->ac97, UCB_IE_RIS, UCB_IE_ADC);	ucb1400_reg_write(ucb->ac97, UCB_IE_FAL, UCB_IE_ADC);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0xffff);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0);	/* Cause an ADC interrupt. */	ucb1400_reg_write(ucb->ac97, UCB_ADC_CR, UCB_ADC_ENA);	ucb1400_reg_write(ucb->ac97, UCB_ADC_CR, UCB_ADC_ENA | UCB_ADC_START);	/* Wait for the conversion to complete. */	timeout = jiffies + HZ/2;	while (!(ucb1400_reg_read(ucb->ac97, UCB_ADC_DATA) &						UCB_ADC_DAT_VALID)) {		cpu_relax();		if (time_after(jiffies, timeout)) {			printk(KERN_ERR "ucb1400: timed out in IRQ probe/n");			probe_irq_off(mask);			return -ENODEV;		}	}	ucb1400_reg_write(ucb->ac97, UCB_ADC_CR, 0);	/* Disable and clear interrupt. */	ucb1400_reg_write(ucb->ac97, UCB_IE_RIS, 0);	ucb1400_reg_write(ucb->ac97, UCB_IE_FAL, 0);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0xffff);	ucb1400_reg_write(ucb->ac97, UCB_IE_CLEAR, 0);	/* Read triggered interrupt. */	ucb->irq = probe_irq_off(mask);	if (ucb->irq < 0 || ucb->irq == NO_IRQ)		return -ENODEV;	return 0;}

//.........这里部分代码省略.........		ucb->irq_pending = 1;		wake_up(&ucb->ts_wait);		return IRQ_HANDLED;	}	return IRQ_NONE;}static int ucb1400_ts_open(struct input_dev *idev){	struct ucb1400 *ucb = input_get_drvdata(idev);	int ret = 0;	BUG_ON(ucb->ts_task);	ucb->ts_task = kthread_run(ucb1400_ts_thread, ucb, "UCB1400_ts");	if (IS_ERR(ucb->ts_task)) {		ret = PTR_ERR(ucb->ts_task);		ucb->ts_task = NULL;	}	return ret;}static void ucb1400_ts_close(struct input_dev *idev){	struct ucb1400 *ucb = input_get_drvdata(idev);	if (ucb->ts_task)	{		kthread_stop(ucb->ts_task);		while(ucb->ts_task!=NULL) udelay(100);	}	ucb1400_ts_irq_disable(ucb);	ucb1400_reg_write(ucb, UCB_TS_CR, 0);}#ifdef CONFIG_PMstatic int ucb1400_ts_resume(struct device *dev){	struct ucb1400 *ucb = dev_get_drvdata(dev);	if (ucb->ts_task) {		/*		 * Restart the TS thread to ensure the		 * TS interrupt mode is set up again		 * after sleep.		 */		ucb->ts_restart = 1;		wake_up(&ucb->ts_wait);	}	return 0;}#else#define ucb1400_ts_resume NULL#endif#ifndef NO_IRQ#define NO_IRQ	0#endif/* * Try to probe our interrupt, rather than relying on lots of * hard-coded machine dependencies. */static int ucb1400_detect_irq(struct ucb1400 *ucb){

static inline void ucb1400_ts_irq_enable(struct snd_ac97 *ac97){    ucb1400_reg_write(ac97, UCB_IE_CLEAR, UCB_IE_TSPX);    ucb1400_reg_write(ac97, UCB_IE_CLEAR, 0);    ucb1400_reg_write(ac97, UCB_IE_FAL, UCB_IE_TSPX);}