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

int twl6040_reg_write(struct twl6040 *twl6040, unsigned int reg, u8 val){	int ret;	mutex_lock(&twl6040->io_mutex);	ret = twl_i2c_write_u8(TWL_MODULE_AUDIO_VOICE, val, reg);	mutex_unlock(&twl6040->io_mutex);	return ret;}

static void omap4430_keypad_led_store(struct led_classdev *led_cdev,				enum led_brightness value){	u8 brightness = 0;	if (value > 1) {		if (value == LED_FULL)			brightness = 0x7f;		else			brightness = (~(value/2)) & 0x7f;		twl_i2c_write_u8(TWL_MODULE_PWM, brightness, KP_LED_PWM1ON);		twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x36, KP_LED_TOGGLE3);	} else {		twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x31, KP_LED_TOGGLE3);		twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x37, KP_LED_TOGGLE3);	}}

static inline void twl4030_enable_write(void){    int err;    err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0xC0,				   PWR_PROTECT_KEY);    if (err) {        printk(KERN_WARNING "I2C error %d while writing TWL4030 PM_MASTER PWR_PROTECT_KEY/n", err);        return ;    }    err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0x0C,				   PWR_PROTECT_KEY);    if (err) {        printk(KERN_WARNING "I2C error %d while writing TWL4030 PM_MASTER PWR_PROTECT_KEY/n", err);        return ;    }}

static void twl6030_phy_shutdown(struct otg_transceiver *x){	struct twl6030_usb *twl;	struct device *dev;	struct twl4030_usb_data *pdata;	/* USB_VBUS_CTRL_CLR */	twl_i2c_write_u8(TWL6030_MODULE_ID1, 0xFF, 0x05);	/* USB_ID_CRTL_CLR */	twl_i2c_write_u8(TWL6030_MODULE_ID1, 0xFF, 0x07);        /* CHARGERUSB_CTRL3 */        twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x21, 0xEA);	twl = xceiv_to_twl(x);	dev  = twl->dev;	pdata = dev->platform_data;	pdata->phy_power(twl->dev, 0, 0);}

int twl6030_mmc_card_detect_config(void){	int ret;	u8 reg_val = 0;		twl6030_interrupt_unmask(TWL6030_MMCDETECT_INT_MASK,						REG_INT_MSK_LINE_B);	twl6030_interrupt_unmask(TWL6030_MMCDETECT_INT_MASK,						REG_INT_MSK_STS_B);	ret = twl_i2c_read_u8(TWL6030_MODULE_ID0, &reg_val, TWL6030_MMCCTRL);	if (ret < 0) {		pr_err("twl6030: Failed to read MMCCTRL, error %d/n", ret);		return ret;	}	reg_val &= ~VMMC_AUTO_OFF;	reg_val |= SW_FC;	ret = twl_i2c_write_u8(TWL6030_MODULE_ID0, reg_val, TWL6030_MMCCTRL);	if (ret < 0) {		pr_err("twl6030: Failed to write MMCCTRL, error %d/n", ret);		return ret;	}		ret = twl_i2c_read_u8(TWL6030_MODULE_ID0, &reg_val,						TWL6030_CFG_INPUT_PUPD3);	if (ret < 0) {		pr_err("twl6030: Failed to read CFG_INPUT_PUPD3, error %d/n",									ret);		return ret;	}	reg_val &= ~(MMC_PU | MMC_PD);	ret = twl_i2c_write_u8(TWL6030_MODULE_ID0, reg_val,						TWL6030_CFG_INPUT_PUPD3);	if (ret < 0) {		pr_err("twl6030: Failed to write CFG_INPUT_PUPD3, error %d/n",									ret);		return ret;	}	return twl6030_irq_base + MMCDETECT_INTR_OFFSET;}

static void vibra_disable_leds(void){   u8 reg;   /* Disable LEDA & LEDB, cannot be used with vibra (PWM) */   twl_i2c_read_u8(TWL4030_MODULE_LED, &reg, LEDEN);   //reg &= ~0x03;   reg &= ~0x33;   //twl_i2c_write_u8(TWL4030_MODULE_LED, LEDEN, reg);   twl_i2c_write_u8(TWL4030_MODULE_LED, reg, LEDEN);}

static inline int twl6030_writeb(struct twl6030_usb *twl, u8 module,						u8 data, u8 address){	int ret = 0;	ret = twl_i2c_write_u8(module, data, address);	if (ret < 0)		dev_err(twl->dev,			"Write[0x%x] Error %d/n", address, ret);	return ret;}

static int omap3evm_bklight_setlevel(struct lcd_panel *panel,						unsigned int level){	u8 c;	if ((level >= 0) && (level <= 100)) {		c = (125 * (100 - level)) / 100 + 2;		twl_i2c_write_u8(TWL4030_MODULE_PWMA, c, TWL_PWMA_PWMAOFF);		bklight_level = level;	}	return 0;}

static int omapbl_set_intensity(struct backlight_device *bd){       int intensity = bd->props.brightness;       int ret;       u8 c;       if (bd->props.power != FB_BLANK_UNBLANK)               intensity = 0;       if (bd->props.fb_blank != FB_BLANK_UNBLANK)               intensity = 0;       if (omapbl_flags & OMAPBL_SUSPENDED)               intensity = 0;       if (intensity == 0)	       printk("Backlight turned off/n");              c = ((125 * intensity) / 100) + 2;#if 0	   if (intensity > 100)	   {		   twl_i2c_read_u8(TWL4030_MODULE_INTBR, &c, 0x0c);		   c &= ~(1 << 3);		   twl_i2c_write_u8 (TWL4030_MODULE_INTBR, c, 0x0c);		   return ret;	   }#endif       /*	* Program the OFF register of PWM1 with user values	*/       ret = twl_i2c_write_u8(TWL4030_MODULE_PWM1, c, TWL_PWM1_PWM1OFF);              if (ret) {	       printk("i2c write failed/n");	       return ret;       }//     printk(KERN_INFO "Backlight altered with value %d./n", intensity);       panel_intensity = intensity;       return 0;}

static int twl4030_config_wakeup3_sequence(u8 address){	int err;	u8 data;	/* Set SLEEP to ACTIVE SEQ address for P3 */	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, address, R_SEQ_ADD_S2A3);	if (err)		goto out;	/* P3 LVL_WAKEUP should be on LEVEL */	err = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &data, R_P3_SW_EVENTS);	if (err)		goto out;	data |= LVL_WAKEUP;	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, data, R_P3_SW_EVENTS);out:	if (err)		pr_err("TWL4030 wakeup sequence for P3 config error/n");	return err;}

static int twl4030_config_sleep_sequence(u8 address){	int err;	/* Set ACTIVE to SLEEP SEQ address in T2 memory*/	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, address, R_SEQ_ADD_A2S);	if (err)		pr_err("TWL4030 sleep sequence config error/n");	return err;}

static int dsi1_panel_set_backlight(struct omap_dss_device *dssdev, int level){	int r;	r = twl_i2c_write_u8(TWL_MODULE_PWM, 0x7F, LED_PWM2OFF);	if (r)		return r;	if (level > 1) {		if (level == 255)			level = 0x7F;		else			level = (~(level/2)) & 0x7F;		r = twl_i2c_write_u8(TWL_MODULE_PWM, level, LED_PWM2ON);		if (r)			return r;		r = twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x30, TWL6030_TOGGLE3);		if (r)			return r;	} else if (level <= 1) {		r = twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x08, TWL6030_TOGGLE3);		if (r)			return r;		r = twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x28, TWL6030_TOGGLE3);		if (r)			return r;		r = twl_i2c_write_u8(TWL6030_MODULE_ID1, 0x00, TWL6030_TOGGLE3);		if (r)			return r;	}	return 0;}

static int twl4030_config_warmreset_sequence(u8 address){	int err;	u8 rd_data;	/* Set WARM RESET SEQ address for P1 */	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, address, R_SEQ_ADD_WARM);	if (err)		goto out;	/* P1/P2/P3 enable WARMRESET */	err = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &rd_data, R_P1_SW_EVENTS);	if (err)		goto out;	rd_data |= ENABLE_WARMRESET;	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, rd_data, R_P1_SW_EVENTS);	if (err)		goto out;	err = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &rd_data, R_P2_SW_EVENTS);	if (err)		goto out;	rd_data |= ENABLE_WARMRESET;	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, rd_data, R_P2_SW_EVENTS);	if (err)		goto out;	err = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &rd_data, R_P3_SW_EVENTS);	if (err)		goto out;	rd_data |= ENABLE_WARMRESET;	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, rd_data, R_P3_SW_EVENTS);out:	if (err)		pr_err("TWL4030 warmreset seq config error/n");	return err;}

void twl4030_poweroff(void){	u8 uninitialized_var(val);	int err;	/* Make sure SEQ_OFFSYNC is set so that all the res goes to wait-on */	err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &val,				   CFG_P123_TRANSITION);	if (err) {		pr_warning("I2C error %d while reading TWL4030 PM_MASTER CFG_P123_TRANSITION/n", err);		return;	}	val |= SEQ_OFFSYNC;	err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, val,				    CFG_P123_TRANSITION);	if (err) {		pr_warning("I2C error %d while writing TWL4030 PM_MASTER CFG_P123_TRANSITION/n", err);		return;	}	err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &val,				  PWR_P1_SW_EVENTS);	if (err) {		pr_warning("I2C error %d while reading TWL4030 PM_MASTER P1_SW_EVENTS/n", err);		return;	}	val |= PWR_STOPON_POWERON | PWR_DEVOFF;	err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, val,				   PWR_P1_SW_EVENTS);	if (err) {		pr_warning("I2C error %d while writing TWL4030 PM_MASTER P1_SW_EVENTS/n", err);		return;	}	return;}

static int omap3evm_panel_init(struct lcd_panel *panel,				struct omapfb_device *fbdev){	gpio_request(LCD_PANEL_LR, "LCD lr");	gpio_request(LCD_PANEL_UD, "LCD ud");	gpio_request(LCD_PANEL_INI, "LCD ini");	gpio_request(LCD_PANEL_RESB, "LCD resb");	gpio_request(LCD_PANEL_QVGA, "LCD qvga");	gpio_direction_output(LCD_PANEL_RESB, 1);	gpio_direction_output(LCD_PANEL_INI, 1);	gpio_direction_output(LCD_PANEL_QVGA, 0);	gpio_direction_output(LCD_PANEL_LR, 1);	gpio_direction_output(LCD_PANEL_UD, 1);	twl_i2c_write_u8(TWL4030_MODULE_LED, 0x11, TWL_LED_LEDEN);	twl_i2c_write_u8(TWL4030_MODULE_PWMA, 0x01, TWL_PWMA_PWMAON);	twl_i2c_write_u8(TWL4030_MODULE_PWMA, 0x02, TWL_PWMA_PWMAOFF);	bklight_level = 100;	return 0;}

static int __devinit twl4030_config_sleep_sequence(u8 address){	int err;		err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, address,				R_SEQ_ADD_A2S);	if (err)		pr_err("TWL4030 sleep sequence config error/n");	return err;}

/* Send a word over the powerbus */static int twl4030_send_pb_msg(unsigned msg){	u8	val;	int	ret;	/* save powerbus configuration */	ret = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &val,			      TWL4030_PM_MASTER_PB_CFG);	if (ret < 0)		return ret;	/* Enable i2c access to powerbus */	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, val | PB_I2C_BWEN,			       TWL4030_PM_MASTER_PB_CFG);	if (ret < 0)		return ret;	ret = twl4030_wait_pb_ready();	if (ret < 0)		return ret;	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, msg >> 8,			       TWL4030_PM_MASTER_PB_WORD_MSB);	if (ret < 0)		return ret;	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, msg & 0xff,			       TWL4030_PM_MASTER_PB_WORD_LSB);	if (ret < 0)		return ret;	ret = twl4030_wait_pb_ready();	if (ret < 0)		return ret;	/* Restore powerbus configuration */	return twl_i2c_write_u8(TWL_MODULE_PM_MASTER, val,				TWL4030_PM_MASTER_PB_CFG);}

/* * In master mode, start the power off sequence. * After a successful execution, TWL shuts down the power to the SoC * and all peripherals connected to it. */void twl4030_power_off(void){	int err;	/* Disable start on charger or VBUS as it can break poweroff */	err = twl4030_starton_mask_and_set(STARTON_VBUS | STARTON_CHG, 0);	if (err)		pr_err("TWL4030 Unable to configure start-up/n");	err = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, PWR_DEVOFF,			       TWL4030_PM_MASTER_P1_SW_EVENTS);	if (err)		pr_err("TWL4030 Unable to power off/n");}