Untitled

Pasted by zyp on Sat Apr 2 16:20:31 2011 UTC as C++ 
 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
I2CConfig i2cconfig = {
	opmodeI2C,
	100000,
	stdDutyCycle,
	0,
	0
};

void cba(I2CDriver* i2cp, I2CSlaveConfig* i2cscfg) {
	if(i2cp->id_slave_config->restart) {
		i2cp->id_slave_config->restart = FALSE;
		i2cMasterReceive(i2cp, i2cscfg);
	} else {
		i2cMasterStop(i2cp);
	}
}

void cbe(I2CDriver* i2cp, I2CSlaveConfig* i2cscfg) {
	while(1);
}

i2cblock_t rxdata[6];
i2cblock_t txdata[2] = {0x1d};

I2CSlaveConfig i2c_gyro = {
	cba,
	
	cbe,
	
	rxdata,
	6,
	6,
	0,
	
	txdata,
	2,
	1,
	0,
	
	0x68,
	TRUE
};

int main(void) {
	halInit();
	chSysInit();
	
	led_thread.start();
	
	i2cStart(&I2CD2, &i2cconfig);
	while(I2CD2.id_state != I2C_READY) {
		chThdSleepMilliseconds(1);
	}
	
	palSetPadMode(GPIOB, 10, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
	palSetPadMode(GPIOB, 11, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
	
	i2cMasterTransmit(&I2CD2, &i2c_gyro);

	...
}