fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-23 07:43:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

px4_mtd: increase retries, wait inbetween, try decreasing frequency

Browse Source
This commit is contained in:
Daniel Agar
2021-12-06 09:37:08 -05:00
parent 1af068179e
commit 9db5bc0755
1 changed files with 22 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files
platforms/nuttx/src/px4/common/px4_mtd.cpp
+22 -14
View File
@@ -74,23 +74,27 @@ static int ramtron_attach(mtd_instance_s &instance)
return ENXIO; return ENXIO;
#else #else
/* initialize the right spi */ /* start the RAMTRON driver, attempt 10 times */
struct spi_dev_s *spi = px4_spibus_initialize(px4_find_spi_bus(instance.devid));
if (spi == nullptr) { int spi_speed_mhz = 10;
PX4_ERR("failed to locate spi bus");
return -ENXIO;
}
/* this resets the spi bus, set correct bus speed again */ for (int i = 0; i < 10; i++) {
SPI_SETFREQUENCY(spi, 10 * 1000 * 1000); /* initialize the right spi */
SPI_SETBITS(spi, 8); struct spi_dev_s *spi = px4_spibus_initialize(px4_find_spi_bus(instance.devid));
SPI_SETMODE(spi, SPIDEV_MODE3);
SPI_SELECT(spi, instance.devid, false);
/* start the RAMTRON driver, attempt 5 times */ if (spi == nullptr) {
PX4_ERR("failed to locate spi bus");
return -ENXIO;
}
/* this resets the spi bus, set correct bus speed again */
SPI_LOCK(spi, true);
SPI_SETFREQUENCY(spi, spi_speed_mhz * 1000 * 1000);
SPI_SETBITS(spi, 8);
SPI_SETMODE(spi, SPIDEV_MODE3);
SPI_SELECT(spi, instance.devid, false);
SPI_LOCK(spi, false);
for (int i = 0; i < 5; i++) {
instance.mtd_dev = ramtron_initialize(spi); instance.mtd_dev = ramtron_initialize(spi);
if (instance.mtd_dev) { if (instance.mtd_dev) {
@@ -101,6 +105,10 @@ static int ramtron_attach(mtd_instance_s &instance)
break; break;
} }
// try reducing speed for next attempt
spi_speed_mhz--;
px4_usleep(10000);
} }
/* if last attempt is still unsuccessful, abort */ /* if last attempt is still unsuccessful, abort */
@@ -109,7 +117,7 @@ static int ramtron_attach(mtd_instance_s &instance)
return -EIO; return -EIO;
} }
int ret = instance.mtd_dev->ioctl(instance.mtd_dev, MTDIOC_SETSPEED, (unsigned long)10 * 1000 * 1000); int ret = instance.mtd_dev->ioctl(instance.mtd_dev, MTDIOC_SETSPEED, (unsigned long)spi_speed_mhz * 1000 * 1000);
if (ret != OK) { if (ret != OK) {
// FIXME: From the previous warning call, it looked like this should have been fatal error instead. Tried // FIXME: From the previous warning call, it looked like this should have been fatal error instead. Tried