Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-28 19:32:36 +08:00
Code Issues Actions 28 Packages Projects Releases Wiki Activity

mtd: Initialized the RAMTRON speed with 30MHz

Browse Source
This commit is contained in:
Niklas Hauser
2024-08-05 15:15:03 +02:00
committed by Daniel Agar
parent 072892fbef
commit 07734c243f
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
platforms/nuttx/src/px4/common/px4_mtd.cpp
+6 -6
View File
@@ -75,11 +75,11 @@ static int ramtron_attach(mtd_instance_s &instance)
return ENXIO; return ENXIO;
#else #else
/* start the RAMTRON driver, attempt 10 times */ /* start the RAMTRON driver at 30MHz */
int spi_speed_mhz = 10; unsigned long spi_speed_hz = 30'000'000;
for (int i = 0; i < 10; i++) { for (int i = 0; spi_speed_hz > 0; i++) {
/* initialize the right spi */ /* initialize the right spi */
struct spi_dev_s *spi = px4_spibus_initialize(px4_find_spi_bus(instance.devid)); struct spi_dev_s *spi = px4_spibus_initialize(px4_find_spi_bus(instance.devid));
@@ -90,7 +90,7 @@ static int ramtron_attach(mtd_instance_s &instance)
/* this resets the spi bus, set correct bus speed again */ /* this resets the spi bus, set correct bus speed again */
SPI_LOCK(spi, true); SPI_LOCK(spi, true);
SPI_SETFREQUENCY(spi, spi_speed_mhz * 1000 * 1000); SPI_SETFREQUENCY(spi, spi_speed_hz);
SPI_SETBITS(spi, 8); SPI_SETBITS(spi, 8);
SPI_SETMODE(spi, SPIDEV_MODE3); SPI_SETMODE(spi, SPIDEV_MODE3);
SPI_SELECT(spi, instance.devid, false); SPI_SELECT(spi, instance.devid, false);
@@ -108,7 +108,7 @@ static int ramtron_attach(mtd_instance_s &instance)
} }
// try reducing speed for next attempt // try reducing speed for next attempt
spi_speed_mhz--; spi_speed_hz -= 1'000'000;
px4_usleep(10000); px4_usleep(10000);
} }
@@ -118,7 +118,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)spi_speed_mhz * 1000 * 1000); int ret = instance.mtd_dev->ioctl(instance.mtd_dev, MTDIOC_SETSPEED, spi_speed_hz);
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