C++ (Cpp) hw_start_i2c Examples

Example #1

File: hw_45.c Project: xin198365/bldc

static msg_t temp_thread(void *arg) {
	(void)arg;

	chRegSetThreadName("I2C Temp samp");

	uint8_t rxbuf[10];
	uint8_t txbuf[10];
	msg_t status = RDY_OK;
	systime_t tmo = MS2ST(5);
	i2caddr_t temp_addr = 0x48;

	hw_start_i2c();
	chThdSleepMilliseconds(10);

	for(;;) {
		if (i2c_running) {
			txbuf[0] = 0x00;
			i2cAcquireBus(&HW_I2C_DEV);
			status = i2cMasterTransmitTimeout(&HW_I2C_DEV, temp_addr, txbuf, 1, rxbuf, 2, tmo);
			i2cReleaseBus(&HW_I2C_DEV);

			if (status == RDY_OK){
				int16_t tempi = rxbuf[0] << 8 | rxbuf[1];
				float temp = (float)tempi;
				temp /= 128;

				temp_now = temp;
			} else {
				// Try to restore the i2c bus
				i2cAcquireBus(&HW_I2C_DEV);
				palSetPadMode(HW_I2C_SCL_PORT, HW_I2C_SCL_PIN,
						PAL_STM32_OTYPE_OPENDRAIN |
						PAL_STM32_OSPEED_MID1 |
						PAL_STM32_PUDR_PULLUP);

				for(int i = 0;i < 16;i++) {
					palClearPad(HW_I2C_SCL_PORT, HW_I2C_SCL_PIN);
					chThdSleep(1);
					palSetPad(HW_I2C_SCL_PORT, HW_I2C_SCL_PIN);
					chThdSleep(1);
				}

				palSetPadMode(HW_I2C_SCL_PORT, HW_I2C_SCL_PIN,
						PAL_MODE_ALTERNATE(HW_I2C_GPIO_AF) |
						PAL_STM32_OTYPE_OPENDRAIN |
						PAL_STM32_OSPEED_MID1 |
						PAL_STM32_PUDR_PULLUP);

				i2cStop(&HW_I2C_DEV);
				i2cStart(&HW_I2C_DEV, &i2cfg);
				i2cReleaseBus(&HW_I2C_DEV);
			}
		}

		chThdSleepMilliseconds(100);
	}

	return 0;
}

Example #2

File: hw_45.c Project: finkultur/bldc

static msg_t temp_thread(void *arg) {
	(void)arg;

	chRegSetThreadName("I2C Temp samp");

	uint8_t rxbuf[10];
	uint8_t txbuf[10];
	msg_t status = RDY_OK;
	systime_t tmo = MS2ST(5);
	i2caddr_t temp_addr = 0x48;

	hw_start_i2c();
	chThdSleepMilliseconds(10);

	for(;;) {
		if (i2c_running) {
			txbuf[0] = 0x00;
			i2cAcquireBus(&HW_I2C_DEV);
			status = i2cMasterTransmitTimeout(&HW_I2C_DEV, temp_addr, txbuf, 1, rxbuf, 2, tmo);
			i2cReleaseBus(&HW_I2C_DEV);

			if (status == RDY_OK){
				int16_t tempi = rxbuf[0] << 8 | rxbuf[1];
				float temp = (float)tempi;
				temp /= 128;

				temp_now = temp;
			} else {
				hw_try_restore_i2c();
			}
		}

		chThdSleepMilliseconds(100);
	}

	return 0;
}