Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-22 07:44:03 -04:00
Code Issues Packages Projects Releases Wiki Activity

HAL_Linux: add export gpio during direction set if not exported during initialisation

Browse Source
This commit is contained in:
bugobliterator 2014-05-24 10:57:39 +05:30 committed by Andrew Tridgell
parent a7ead42f52
commit 85d10e2ce3
1 changed files with 15 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
libraries/AP_HAL_Linux/GPIO.cpp
View File

@ -60,14 +60,27 @@ void LinuxGPIO::init()
void LinuxGPIO::pinMode(uint8_t pin, uint8_t output)
{
int fd;
int fd,len;
char buf[64];
snprintf(buf, sizeof(buf), SYSFS_GPIO_DIR "/gpio%d/direction", pin);
fd = ::open(buf, O_WRONLY);
if (fd < 0) {
perror("LinuxGPIO::direction");
fd = open(SYSFS_GPIO_DIR "/export", O_WRONLY); //try exporting GPIO pin
if (fd < 0) {
perror("LinuxGPIO::direction");
}
len = snprintf(buf, sizeof(buf), "%d", pin);
::write(fd, buf, len);
close(fd);
snprintf(buf, sizeof(buf), SYSFS_GPIO_DIR "/gpio%d/direction", pin); //retry writing direction
fd = ::open(buf, O_WRONLY);
if (fd < 0) {
perror("LinuxGPIO::direction"); //report faillure
}
}
if (output == GPIO_OUTPUT)