57 lines
1018 B
C
57 lines
1018 B
C
|
#include "ch.h"
|
||
|
#include "hal.h"
|
||
|
|
||
|
#include "i2c_pns.h"
|
||
|
|
||
|
#include "lis3.h"
|
||
|
#include "tmp75.h"
|
||
|
#include "max1236.h"
|
||
|
|
||
|
/* I2C1 */
|
||
|
static const I2CConfig i2cfg1 = {
|
||
|
OPMODE_I2C,
|
||
|
100000,
|
||
|
STD_DUTY_CYCLE,
|
||
|
0,
|
||
|
0,
|
||
|
0,
|
||
|
0,
|
||
|
};
|
||
|
|
||
|
/* I2C2 */
|
||
|
static const I2CConfig i2cfg2 = {
|
||
|
OPMODE_I2C,
|
||
|
100000,
|
||
|
STD_DUTY_CYCLE,
|
||
|
0,
|
||
|
0,
|
||
|
0,
|
||
|
0,
|
||
|
};
|
||
|
|
||
|
|
||
|
|
||
|
void I2CInit_pns(void){
|
||
|
i2cInit();
|
||
|
|
||
|
i2cStart(&I2CD1, &i2cfg1);
|
||
|
i2cStart(&I2CD2, &i2cfg2);
|
||
|
|
||
|
/* tune ports for I2C1*/
|
||
|
palSetPadMode(IOPORT2, 6, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
|
||
|
palSetPadMode(IOPORT2, 7, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
|
||
|
|
||
|
/* tune ports for I2C2*/
|
||
|
palSetPadMode(IOPORT2, 10, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
|
||
|
palSetPadMode(IOPORT2, 11, PAL_MODE_STM32_ALTERNATE_OPENDRAIN);
|
||
|
|
||
|
/* startups. Pauses added just to be safe */
|
||
|
chThdSleepMilliseconds(1000);
|
||
|
init_max1236();
|
||
|
chThdSleepMilliseconds(1000);
|
||
|
init_lis3();
|
||
|
chThdSleepMilliseconds(1000);
|
||
|
}
|
||
|
|
||
|
|