Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_HAL_Linux: fixed RPi version detection on kernel 4.9

Browse Source
This commit is contained in:
Dmitri Ranfft 2017-12-06 13:04:06 +01:00 committed by Lucas De Marchi
parent f86d4466bd
commit 05ebabbf6b
1 changed files with 25 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
libraries/AP_HAL_Linux/Util_RPI.cpp
View File

@ -28,9 +28,34 @@ UtilRPI::UtilRPI()
_check_rpi_version();
}
#define MAX_SIZE_LINE 50
int UtilRPI::_check_rpi_version()
{
int hw;
char buffer[MAX_SIZE_LINE] = { 0 };
FILE* f = fopen("/sys/firmware/devicetree/base/model", "r");
if (f != nullptr && fgets(buffer, MAX_SIZE_LINE, f) != nullptr) {
int ret = sscanf(buffer+12, "%d", &_rpi_version);
fclose(f);
if (ret != EOF) {
// Preserving old behavior.
if (_rpi_version > 2) {
_rpi_version = 2;
}
// RPi 1 doesn't have a number there, so sscanf() won't have read anything.
else if (_rpi_version == 0) {
_rpi_version = 1;
}
printf("%s. (intern: %d)\n", buffer, _rpi_version);
return _rpi_version;
}
}
// Attempting old method if the version couldn't be read with the new one.
hw = Util::from(hal.util)->get_hw_arm32();
if (hw == UTIL_HARDWARE_RPI2) {