rusefi
/
bldc
mirror of https://github.com/rusefi/bldc.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

fixing autoformat issues 

Kept a few corrections
This commit is contained in:
Esben Rasmussen 2020-07-02 12:26:28 +02:00
parent 992641275d
commit 8ca85d26d5
2 changed files with 37 additions and 59 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

30
imu/imu.c
View File

@ -99,23 +99,19 @@ void imu_init(imu_config *set) {
BMI160_SPI_PORT_MOSI, BMI160_SPI_PIN_MOSI,
BMI160_SPI_PORT_MISO, BMI160_SPI_PIN_MISO);
#endif
}
else if (set->type == IMU_TYPE_EXTERNAL_MPU9X50) {
} else if (set->type == IMU_TYPE_EXTERNAL_MPU9X50) {
imu_init_mpu9x50(HW_I2C_SDA_PORT, HW_I2C_SDA_PIN,
HW_I2C_SCL_PORT, HW_I2C_SCL_PIN);
}
else if (set->type == IMU_TYPE_EXTERNAL_ICM20948) {
} else if (set->type == IMU_TYPE_EXTERNAL_ICM20948) {
imu_init_icm20948(HW_I2C_SDA_PORT, HW_I2C_SDA_PIN,
HW_I2C_SCL_PORT, HW_I2C_SCL_PIN, 0);
} else if (set->type == IMU_TYPE_EXTERNAL_BMI160) {
imu_init_bmi160(HW_I2C_SDA_PORT, HW_I2C_SDA_PIN,
HW_I2C_SCL_PORT, HW_I2C_SCL_PIN);
}else if(set->type == IMU_TYPE_EXTERNAL_LSM6DS3){
} else if(set->type == IMU_TYPE_EXTERNAL_LSM6DS3) {
imu_init_lsm6ds3(HW_I2C_SDA_PORT, HW_I2C_SDA_PIN,
HW_I2C_SCL_PORT, HW_I2C_SCL_PIN);
}
else if (set->type == IMU_TYPE_EXTERNAL_BMI160)
{
} else if (set->type == IMU_TYPE_EXTERNAL_BMI160) {
imu_init_bmi160_i2c(HW_I2C_SDA_PORT, HW_I2C_SDA_PIN,
HW_I2C_SCL_PORT, HW_I2C_SCL_PIN);
}
@ -142,8 +138,7 @@ void imu_init_mpu9x50(stm32_gpio_t *sda_gpio, int sda_pin,
}
void imu_init_icm20948(stm32_gpio_t *sda_gpio, int sda_pin,
stm32_gpio_t *scl_gpio, int scl_pin,
int ad0_val) {
stm32_gpio_t *scl_gpio, int scl_pin, int ad0_val) {
imu_stop();
m_i2c_bb.sda_gpio = sda_gpio;
@ -182,8 +177,7 @@ void imu_init_bmi160_spi(
stm32_gpio_t *nss_gpio, int nss_pin,
stm32_gpio_t *sck_gpio, int sck_pin,
stm32_gpio_t *mosi_gpio, int mosi_pin,
stm32_gpio_t *miso_gpio, int miso_pin)
{
stm32_gpio_t *miso_gpio, int miso_pin) {
imu_stop();
m_spi_bb.nss_gpio = nss_gpio;
@ -471,15 +465,9 @@ static void imu_read_callback(float *accel, float *gyro, float *mag)
float s3 = sinf(m_settings.rot_roll * M_PI / 180.0);
float c3 = cosf(m_settings.rot_roll * M_PI / 180.0);
float m11 = c1 * c2;
float m12 = c1 * s2 * s3 - c3 * s1;
float m13 = s1 * s3 + c1 * c3 * s2;
float m21 = c2 * s1;
float m22 = c1 * c3 + s1 * s2 * s3;
float m23 = c3 * s1 * s2 - c1 * s3;
float m31 = -s2;
float m32 = c2 * s3;
float m33 = c2 * c3;
float m11 = c1 * c2; float m12 = c1 * s2 * s3 - c3 * s1; float m13 = s1 * s3 + c1 * c3 * s2;
float m21 = c2 * s1; float m22 = c1 * c3 + s1 * s2 * s3; float m23 = c3 * s1 * s2 - c1 * s3;
float m31 = -s2; float m32 = c2 * s3; float m33 = c2 * c3;
m_accel[0] = accel[0] * m11 + accel[1] * m12 + accel[2] * m13;
m_accel[1] = accel[0] * m21 + accel[1] * m22 + accel[2] * m23;

30
spi_bb.c
View File

@ -37,22 +37,18 @@ void spi_bb_init(spi_bb_state *s) {
}
uint8_t spi_exchange_8(spi_bb_state *s, uint8_t x)
{
uint8_t spi_exchange_8(spi_bb_state *s, uint8_t x) {
uint8_t rx;
spi_transfer_8(s ,&rx, &x, 1);
return rx;
}
void spi_transfer_8(spi_bb_state *s, uint8_t *in_buf, const uint8_t *out_buf, int length)
{
for (int i = 0; i < length; i++)
{
void spi_transfer_8(spi_bb_state *s, uint8_t *in_buf, const uint8_t *out_buf, int length) {
for (int i = 0; i < length; i++) {
uint8_t send = out_buf ? out_buf[i] : 0xFF;
uint8_t receive = 0;
for (int bit = 0; bit < 8; bit++)
{
for (int bit = 0; bit < 8; bit++) {
palWritePad(s->mosi_gpio, s->mosi_pin, send >> 7);
send <<= 1;
@ -74,39 +70,33 @@ void spi_transfer_8(spi_bb_state *s, uint8_t *in_buf, const uint8_t *out_buf, in
// does 5 samples of each pad read, to minimize noise
receive <<= 1;
if (samples > 2)
{
if (samples > 2) {
receive |= 1;
}
spi_delay();
}
if (in_buf)
{
if (in_buf) {
in_buf[i] = receive;
}
}
}
void spi_begin(spi_bb_state *s)
{
void spi_begin(spi_bb_state *s) {
spi_delay();
palClearPad(s->nss_gpio, s->nss_pin);
spi_delay();
}
void spi_end(spi_bb_state *s)
{
void spi_end(spi_bb_state *s) {
spi_delay();
palSetPad(s->nss_gpio, s->nss_pin);
spi_delay();
}
void spi_delay(void)
{
for (volatile int i = 0; i < 40; i++)
{
void spi_delay(void) {
for (volatile int i = 0; i < 40; i++) {
__NOP();
}
}