Run PX4 on crazyflie2.1 #15361

LJ0707 · 2020-07-17T14:48:41Z

I want to run PX4 on crazyflie2.1.But now PX4 only support crazyflie2.0.I know there are some difference between crazyflie2.0 and crazyflie2.1.

crazyflie2.0: https://store.bitcraze.io/products/crazyflie-2-0
crazyflie2.1: https://store.bitcraze.io/products/crazyflie-2-1
So I add bmi088 and bmp388 drivers in ./boards/bitcraze/crazyflie/default.cmake.

DRIVERS
		barometer/lps25h
		barometer/bmp388
		distance_sensor/vl53lxx
		gps
		imu/bmi088
		imu/mpu9250
		optical_flow/pmw3901
		px4fmu

And I start them in ./boards/bitcraze/crazyflie/init/rc.borad_sensors.

adc start

# Onboard I2C
mpu9250 -I -R 12 start
#bmi088 -s -A -G -R start
bmi088 -A -R 10 -s start

bmi088 -G -R 10 -s start

# I2C bypass of mpu
lps25h -I start
bmp388 -I start

# Optical flow deck
vl53lxx start -X

But in qgroundcontrol when I input command to check sensors status，there is no sensor.

The text was updated successfully, but these errors were encountered:

dagar · 2020-07-17T21:32:21Z

Waiting on I2C support for the BMI088.

datwwe · 2020-08-04T10:59:45Z

I want to run PX4 on crazyflie2.1.But now PX4 only support crazyflie2.0.I know there are some difference between crazyflie2.0 and crazyflie2.1.
* crazyflie2.0:  https://store.bitcraze.io/products/crazyflie-2-0

* crazyflie2.1:  https://store.bitcraze.io/products/crazyflie-2-1
  So I add bmi088 and bmp388 drivers in ./boards/bitcraze/crazyflie/default.cmake.
DRIVERS
		barometer/lps25h
		barometer/bmp388
		distance_sensor/vl53lxx
		gps
		imu/bmi088
		imu/mpu9250
		optical_flow/pmw3901
		px4fmu
And I start them in ./boards/bitcraze/crazyflie/init/rc.borad_sensors.
adc start

# Onboard I2C
mpu9250 -I -R 12 start
#bmi088 -s -A -G -R start
bmi088 -A -R 10 -s start

bmi088 -G -R 10 -s start

# I2C bypass of mpu
lps25h -I start
bmp388 -I start

# Optical flow deck
vl53lxx start -X
But in qgroundcontrol when I input command to check sensors status，there is no sensor.

Hi, i'm trying to upload px4 firmware onto CF2.1 and you seems to made it. Can you please help?

LJ0707 · 2020-08-07T12:51:41Z

make bitcraze_crazyflie_default menuconfig
Go to: Devices Drivers -> Serial Driver Support -> Serial Console . And select the USART3.
2.make bitcraze_crazyflie_default upload.
I follow this intruction to upload px4 firmware onto CF2.1.
https://docs.px4.io/v1.9.0/en/complete_vehicles/crazyflie2.html

But when I upload px4 firmware onto CF2.1.I cannot start sensors.Can you please help.

dagar · 2020-08-07T13:50:52Z

Can you try this PR? #15421

datwwe · 2020-08-14T09:03:47Z

Can you try this PR? #15421

The CF2.1 use BMI088(not mpu9250 like CF2.0) imu so i think we also needs some drivers( like other imu in src/drivers/imu) not just editting some configs..
Btw, are you developing on CF2.1?

LJ0707 · 2020-08-14T09:16:00Z

I find a bmi088 driver.It support i2c.
https://github.com/BoschSensortec/BMI08x-Sensor-API
Now I am trying to add it to CF2.1.But I am not sure it will work.
Could you give me some idea?

datwwe · 2020-08-14T09:24:33Z

I find a bmi088 driver.It support i2c.
https://github.com/BoschSensortec/BMI08x-Sensor-API
Now I am trying to add it to CF2.1.But I am not sure it will work.
Could you give me some idea?

if you direct to /src/drivers/imu/borsch/ you'll see BMI088, and BMP388 is in /src/drivers/barometer.
So i think u should edit the config to those direction.
P/s : can i add your contact for more instance reply cause i'm also making some stuffs wwith CF2.1 PX4

LJ0707 · 2020-08-14T09:42:41Z

Thank you.My mail address is 2276835336@qq.com.

KimHyungSub · 2020-08-27T20:04:40Z

@LJ0707 @datwwe
Are you guys having any progress? I am also working with CF2.1. But, I have the same problem.

diegomrt · 2020-09-24T00:25:09Z

Hi @KimHyungSub @LJ0707 @datwwe,

Any progress so far? It would be nice to know if you finally made PX4 work on our Crazyflies 2.1

jgoppert · 2020-09-30T21:02:57Z

@dagar @LJ0707 We are starting to work on this as well for crazyflie 2.1 support. We have tried #15552, but it doesn't seem like that was taken very far except for the bringing in the bosch code, it doesn't seem to build the module.

dagar · 2020-09-30T21:11:04Z

I have a Crazyflie v2.1 in a box somewhere, I'll take a look this weekend.

dagar · 2020-10-05T02:11:44Z

I'm working on adding generic register read/write helpers to the I2C/SPI interfaces so we can cleanly support drivers like the BMI088 for both.

jgoppert · 2020-10-05T14:54:05Z

Thanks, really appreciate it. Let me know if there is anything we can do to help.

jgoppert · 2020-10-07T20:09:41Z

@dagar Do you have a branch going that we could help test and possibly help with development?

jgoppert · 2020-10-14T20:13:11Z

@dagar Any updates on this? We would really like to push this through to support PX4 on the crazyflies in our lab. We are willing to do the leg work, but just want to make sure we sync up with you. If you can get us started, we can do the rest. We have crazyflies with debuggers etc ready to go.

zp-yang · 2020-10-28T18:35:25Z

While trying to connect bmi088 on SPI bus
initSPIDevice(DRV_ACC_DEVTYPE_BMI088, SPI::CS{GPIO::PortB, GPIO::Pin1}), initSPIDevice(DRV_GYR_DEVTYPE_BMI088, SPI::CS{GPIO::PortB, GPIO::Pin0}),
The probe() function gives a erroneous reading of chip_id.

From gdb, the 'ACC_CHIP_ID' read is '0xff', while the actual 'ID' is '0x1e'.

Any ideas why this happens? Thanks! @dagar @LJ0707

JizhouChen · 2020-11-04T18:39:50Z

Hi guys! @zp-yang and I are trying to get PX4 to run on Crazyflie 2.1 as well. We are new to driver development.
This is the branch we are working on: https://github.com/zp-yang/Firmware/tree/pr-crazyflie_bmi088_i2c

Currently, the failing point we found is at if (ACC_CHIP_ID != ID) in BMI088_Accelerometer::probe().

int BMI088_Accelerometer::probe()
	RegisterRead(Register::ACC_CHIP_ID);

	const uint8_t ACC_CHIP_ID = RegisterRead(Register::ACC_CHIP_ID);

	if (ACC_CHIP_ID != ID) {
		DEVICE_DEBUG("unexpected ACC_CHIP_ID 0x%02x", ACC_CHIP_ID);
		return PX4_ERROR;
	}

	return PX4_OK;

The ID is preset to 0x1E, which is the reset value of ACC_CHIP_ID register, as shown on page 25 of the datasheet. While the ACC_CHIP_ID obtained by RegisterRead(Register::ACC_CHIP_ID) is 0x00, hence failing condition check.

I traced down the function call flow:

BMI088_Accelerometer::probe()[src/drivers/imu/bosch/bmi088/BMI088_Accelerometer.cpp]
->RegisterRead(Register::ACC_CHIP_ID) [src/drivers/imu/bosch/bmi088/BMI088_Accelerometer.cpp]
->SPI::transfer(cmd, cmd, sizeof(cmd))[src/lib/drivers/device/nuttx/SPI.cpp]
->SPI::_transferhword(uint16_t *send, uint16_t *recv, unsigned len)[src/lib/drivers/device/nuttx/SPI.cpp]
->SPI_EXCHANGE(_dev, send, recv, len) [src/lib/drivers/device/nuttx/SPI.cpp]
->#define SPI_EXCHANGE(d,t,r,l) ((d)->ops->exchange(d,t,r,l))[platforms/nuttx/NuttX/nuttx/include/nuttx/spi/spi.h]

I don't see any logical flaw along the flow. My guess is that the issue of RegisterRead(Register::ACC_CHIP_ID) not returning 0x1E might be associated with hardware specifications in the code, e.g., pin number or bus number (I'm not as familiar with the hardware, this is just my guess). We will look into this as well as keep debugging to see if any issue happens during reading.

We will keep posting updates here. If anyone has experience in driver development and is interested in working on this issue as well, please feel free to join us. It would be great if we could have someone with experience. If you are too busy to work on this with us, any advice would to greatly appreciated too :)

####################################
Something to add on:

Waiting on I2C support for the BMI088.

@dagar Daniel said waiting on I2C support for the BMI088. Based on what I found in the crazyflie-firmware, BMI088 on Crazyflie supports both SPI and I2C. I was wondering if developing I2C support is a must? Or as long as we fix the SPI support of BMI088 in PX4, we would be able to get Crazyflie 2.1 to fly?

Updated 11/8/2020:
BMI088 does not appear to support SPI as the CS pins are not used according to the chip diagram of BMI088 on the second page. Implementing I2C support for BMI088 should be the only option.

Thank you :)

TheLegendaryJedi · 2020-11-08T13:43:22Z

Hi @JizhouChen,

I'm trying to make it work too but I'm having a hard time figuring out on how to debug it? How could you check that the ACC_CHIP_ID is returning 0xFF?

Thanks

JizhouChen · 2020-11-08T17:41:43Z

Hi @JizhouChen,

I'm trying to make it work too but I'm having a hard time figuring out on how to debug it? How could you check that the ACC_CHIP_ID is returning 0xFF?

Thanks

You need to have a debugger (the one I'm using is ST-LINK/V2) and debug the firmware with gdb

TheLegendaryJedi · 2020-11-08T18:20:19Z

Thanks @JizhouChen :)

I'll need to buy one then.

Thanks

JizhouChen · 2020-11-18T22:02:21Z

Update 11/18:
We have implemented the BMI088 I2C interface and got PX4 run on Crazyflie (with one issue).
https://github.com/zp-yang/Firmware/tree/pr-crazyflie_bmi088_i2c

Based on our debugging result, the bmi088_i2c_main() goes through without any problem. We suspect that it has something to do with our I/O implementation and we will keep debugging it.

Please feel free to leave a comment if you have any thoughts. Thank you!

TheLegendaryJedi · 2020-11-19T08:37:48Z

Hi @JizhouChen I've been working on an I2C version for the BMI088 too. I can start accel and gyro on the I2C bus but I'm having some problems with the FIFO data samples. I checked yours and it's very similar we both used Daniel's SPI implementation as a base. But for some reason the fifo read is not working as expected. I tried to implement the recommended steps in the datasheet for self-test and sometimes it works and sometimes it doesn't. I hit a bit of a wall now. There was some iterations that I was able to publish correct data frames to PX4 but I can't complete accel calibration (it seems that some of the data don't have correct values when published).

If you want, check it.

https://github.com/TheLegendaryJedi/Firmware/tree/crazyflieV21

Thanks

JizhouChen · 2020-11-19T15:36:35Z

@TheLegendaryJedi Awesome! We will check it out and update you once we find anything.

TheLegendaryJedi · 2020-11-21T13:59:34Z

The problem I'm having now is during the fifo transfer. That is, I check the number of samples available multiply by 7 specified by the datasheet (6 for x,y,z and one for header) and the transfer always fails, it returns -1.

JizhouChen · 2020-11-23T22:41:56Z

Hi @TheLegendaryJedi , are you on the PX4 Slack channel (px4.slack.com) by any chance?

TheLegendaryJedi · 2020-11-24T01:08:08Z

Hi @TheLegendaryJedi , are you on the PX4 Slack channel (px4.slack.com) by any chance?

Yes, I'm "GONCALO" there.

I just pushed some more commits to the branch. I was able to make it work (but without the FIFO). Now I'm having problems with the attitude estimator.

If you test with my branch you should be able to calibrate accel and gyro with no problem at all.

jancoow · 2020-12-04T15:01:49Z

Hi.

I'm working on getting the BMI088 with I2C and FIFO to work as well for the PX4 with a crazyflight2.1
Anyone having some progress on this implementation? It seems that reading from the FIFO buffer register is not working properly.

I've tried lowering the output data rate to 400hz because this is recommended with an I2C speed of 100kHz, but with no luck.

TheLegendaryJedi · 2020-12-04T20:13:47Z

Hi.

I'm working on getting the BMI088 with I2C and FIFO to work as well for the PX4 with a crazyflight2.1
Anyone having some progress on this implementation? It seems that reading from the FIFO buffer register is not working properly.

I've tried lowering the output data rate to 400hz because this is recommended with an I2C speed of 100kHz, but with no luck.

Hi @jancoow, I've been working on it too. Are you on slack? We have a thread there regarding this.

Basically I started with fifo and then I checked that the data was all wrong. I tried with 100kHz and 400kHz and no luck.

Next I tried to read the data directly from the data registers and I was able to calibrate it. But during the gyro calibration the QGC is always saying that the drone is moving. That's because the gyro data varies a lot. The accel is all good for calibration.

But now I'm trying again to implement it with fifo because it's the correct way to do it.

I would like to know if crazyflie2.1 original firmware is using fifo or not. I need to ask on their forum.

Eastonboy99 · 2022-02-03T15:52:44Z

Any update on this?
It seems like crazyflie PX4 support is no more as the cfbridge.py that is referenced here has been removed from the crazyflie python library.

dagar · 2022-02-03T18:12:08Z

If anyone is motivated to bring these back to full support I'd be happy to try and assist (eg debug drivers), but otherwise I don't think I have time to fully review and test the system.

dagar added the Admin: Enhancement (improvement) 💡 label Jul 17, 2020

weekly-digest bot mentioned this issue Jul 19, 2020

Weekly Digest (12 July, 2020 - 19 July, 2020) #15376

Closed

This was referenced Jul 24, 2020

How to run px4 on crazyflie 2.1 #15250

Closed

Adding support for Crazyflie 2.1 #14593

Closed

slgrobotics mentioned this issue May 16, 2024

Fixing BMI088 IMU connected via I2C #23141

Open

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

Run PX4 on crazyflie2.1 #15361

Run PX4 on crazyflie2.1 #15361

LJ0707 commented Jul 17, 2020

dagar commented Jul 17, 2020

datwwe commented Aug 4, 2020

LJ0707 commented Aug 7, 2020

dagar commented Aug 7, 2020

datwwe commented Aug 14, 2020

LJ0707 commented Aug 14, 2020

datwwe commented Aug 14, 2020

LJ0707 commented Aug 14, 2020

KimHyungSub commented Aug 27, 2020

diegomrt commented Sep 24, 2020

jgoppert commented Sep 30, 2020

dagar commented Sep 30, 2020

dagar commented Oct 5, 2020

jgoppert commented Oct 5, 2020

jgoppert commented Oct 7, 2020

jgoppert commented Oct 14, 2020 •

edited

Loading

zp-yang commented Oct 28, 2020

JizhouChen commented Nov 4, 2020 •

edited

Loading

TheLegendaryJedi commented Nov 8, 2020

JizhouChen commented Nov 8, 2020

TheLegendaryJedi commented Nov 8, 2020

JizhouChen commented Nov 18, 2020 •

edited

Loading

TheLegendaryJedi commented Nov 19, 2020 •

edited

Loading

JizhouChen commented Nov 19, 2020

TheLegendaryJedi commented Nov 21, 2020

JizhouChen commented Nov 23, 2020 •

edited

Loading

TheLegendaryJedi commented Nov 24, 2020 •

edited

Loading

jancoow commented Dec 4, 2020

TheLegendaryJedi commented Dec 4, 2020

Eastonboy99 commented Feb 3, 2022

dagar commented Feb 3, 2022

Run PX4 on crazyflie2.1 #15361

Run PX4 on crazyflie2.1 #15361

Comments

LJ0707 commented Jul 17, 2020

dagar commented Jul 17, 2020

datwwe commented Aug 4, 2020

LJ0707 commented Aug 7, 2020

dagar commented Aug 7, 2020

datwwe commented Aug 14, 2020

LJ0707 commented Aug 14, 2020

datwwe commented Aug 14, 2020

LJ0707 commented Aug 14, 2020

KimHyungSub commented Aug 27, 2020

diegomrt commented Sep 24, 2020

jgoppert commented Sep 30, 2020

dagar commented Sep 30, 2020

dagar commented Oct 5, 2020

jgoppert commented Oct 5, 2020

jgoppert commented Oct 7, 2020

jgoppert commented Oct 14, 2020 • edited Loading

zp-yang commented Oct 28, 2020

JizhouChen commented Nov 4, 2020 • edited Loading

TheLegendaryJedi commented Nov 8, 2020

JizhouChen commented Nov 8, 2020

TheLegendaryJedi commented Nov 8, 2020

JizhouChen commented Nov 18, 2020 • edited Loading

TheLegendaryJedi commented Nov 19, 2020 • edited Loading

JizhouChen commented Nov 19, 2020

TheLegendaryJedi commented Nov 21, 2020

JizhouChen commented Nov 23, 2020 • edited Loading

TheLegendaryJedi commented Nov 24, 2020 • edited Loading

jancoow commented Dec 4, 2020

TheLegendaryJedi commented Dec 4, 2020

Eastonboy99 commented Feb 3, 2022

dagar commented Feb 3, 2022

jgoppert commented Oct 14, 2020 •

edited

Loading

JizhouChen commented Nov 4, 2020 •

edited

Loading

JizhouChen commented Nov 18, 2020 •

edited

Loading

TheLegendaryJedi commented Nov 19, 2020 •

edited

Loading

JizhouChen commented Nov 23, 2020 •

edited

Loading

TheLegendaryJedi commented Nov 24, 2020 •

edited

Loading