Browse Source

AP_HAL_Linux: AnalogIn_IIO: formatting fixes

- remove trailing whitespaces
  - use pragma 0 for header guard
master
Lucas De Marchi 9 years ago
parent
commit
be2af0877c
  1. 28
      libraries/AP_HAL_Linux/AnalogIn_IIO.cpp
  2. 9
      libraries/AP_HAL_Linux/AnalogIn_IIO.h

28
libraries/AP_HAL_Linux/AnalogIn_IIO.cpp

@ -6,8 +6,6 @@
extern const AP_HAL::HAL& hal; extern const AP_HAL::HAL& hal;
const char* IIOAnalogSource::analog_sources[IIO_ANALOG_IN_COUNT] = { const char* IIOAnalogSource::analog_sources[IIO_ANALOG_IN_COUNT] = {
#if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_PXF #if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_PXF
"in_voltage0_raw", "in_voltage0_raw",
@ -16,8 +14,8 @@ const char* IIOAnalogSource::analog_sources[IIO_ANALOG_IN_COUNT] = {
"in_voltage3_raw", "in_voltage3_raw",
"in_voltage4_raw", "in_voltage4_raw",
"in_voltage5_raw", "in_voltage5_raw",
"in_voltage6_raw", "in_voltage6_raw",
"in_voltage7_raw", "in_voltage7_raw",
#else #else
"in_voltage0_raw", "in_voltage0_raw",
#endif #endif
@ -31,7 +29,7 @@ IIOAnalogSource::IIOAnalogSource(int16_t pin, float initial_value) :
_pin_fd(-1) _pin_fd(-1)
{ {
init_pins(); init_pins();
select_pin(); select_pin();
} }
void IIOAnalogSource::init_pins(void) void IIOAnalogSource::init_pins(void)
@ -41,11 +39,11 @@ void IIOAnalogSource::init_pins(void)
// Construct the path by appending strings // Construct the path by appending strings
strncpy(buf, IIO_ANALOG_IN_DIR, sizeof(buf)); strncpy(buf, IIO_ANALOG_IN_DIR, sizeof(buf));
strncat(buf, IIOAnalogSource::analog_sources[i], sizeof(buf)); strncat(buf, IIOAnalogSource::analog_sources[i], sizeof(buf));
fd_analog_sources[i] = open(buf, O_RDONLY | O_NONBLOCK); fd_analog_sources[i] = open(buf, O_RDONLY | O_NONBLOCK);
if (fd_analog_sources[i] == -1) { if (fd_analog_sources[i] == -1) {
::printf("Failed to open analog pin %s\n", buf); ::printf("Failed to open analog pin %s\n", buf);
} }
} }
} }
@ -73,7 +71,7 @@ void IIOAnalogSource::reopen_pin(void)
if (_pin < 0) { if (_pin < 0) {
return; return;
} }
if (_pin > IIO_ANALOG_IN_COUNT) { if (_pin > IIO_ANALOG_IN_COUNT) {
// invalid pin // invalid pin
return; return;
@ -82,7 +80,7 @@ void IIOAnalogSource::reopen_pin(void)
// Construct the path by appending strings // Construct the path by appending strings
strncpy(buf, IIO_ANALOG_IN_DIR, sizeof(buf)); strncpy(buf, IIO_ANALOG_IN_DIR, sizeof(buf));
strncat(buf, IIOAnalogSource::analog_sources[_pin], sizeof(buf)); strncat(buf, IIOAnalogSource::analog_sources[_pin], sizeof(buf));
fd_analog_sources[_pin] = open(buf, O_RDONLY | O_NONBLOCK); fd_analog_sources[_pin] = open(buf, O_RDONLY | O_NONBLOCK);
if (fd_analog_sources[_pin] == -1) { if (fd_analog_sources[_pin] == -1) {
::printf("Failed to open analog pin %s\n", buf); ::printf("Failed to open analog pin %s\n", buf);
@ -90,7 +88,7 @@ void IIOAnalogSource::reopen_pin(void)
_pin_fd = fd_analog_sources[_pin]; _pin_fd = fd_analog_sources[_pin];
} }
float IIOAnalogSource::read_average() float IIOAnalogSource::read_average()
{ {
read_latest(); read_latest();
if (_sum_count == 0) { if (_sum_count == 0) {
@ -106,7 +104,7 @@ float IIOAnalogSource::read_average()
return _value; return _value;
} }
float IIOAnalogSource::read_latest() float IIOAnalogSource::read_latest()
{ {
char sbuf[10]; char sbuf[10];
@ -119,7 +117,7 @@ float IIOAnalogSource::read_latest()
pread(_pin_fd, sbuf, sizeof(sbuf)-1, 0); pread(_pin_fd, sbuf, sizeof(sbuf)-1, 0);
#if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_PXF #if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_PXF
_latest = atoi(sbuf) * BBB_VOLTAGE_SCALING; _latest = atoi(sbuf) * BBB_VOLTAGE_SCALING;
#else #else
_latest = atoi(sbuf); _latest = atoi(sbuf);
#endif #endif
_sum_value += _latest; _sum_value += _latest;
@ -129,12 +127,12 @@ float IIOAnalogSource::read_latest()
} }
// output is in volts // output is in volts
float IIOAnalogSource::voltage_average() float IIOAnalogSource::voltage_average()
{ {
return read_average(); return read_average();
} }
float IIOAnalogSource::voltage_latest() float IIOAnalogSource::voltage_latest()
{ {
read_latest(); read_latest();
return _latest; return _latest;
@ -152,7 +150,7 @@ void IIOAnalogSource::set_pin(uint8_t pin)
// _sum_ratiometric = 0; // _sum_ratiometric = 0;
_sum_count = 0; _sum_count = 0;
_latest = 0; _latest = 0;
_value = 0; _value = 0;
select_pin(); select_pin();
// _value_ratiometric = 0; // _value_ratiometric = 0;
hal.scheduler->resume_timer_procs(); hal.scheduler->resume_timer_procs();

9
libraries/AP_HAL_Linux/AnalogIn_IIO.h

@ -1,6 +1,4 @@
#pragma once
#ifndef __AP_HAL_IIO_ANALOGIN_H__
#define __AP_HAL_IIO_ANALOGIN_H__
#include "AP_HAL_Linux.h" #include "AP_HAL_Linux.h"
#include <AP_ADC/AP_ADC.h> #include <AP_ADC/AP_ADC.h>
@ -12,7 +10,7 @@
#include <unistd.h> #include <unistd.h>
#include <stdlib.h> #include <stdlib.h>
#if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_PXF #if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_PXF
#define IIO_ANALOG_IN_COUNT 8 #define IIO_ANALOG_IN_COUNT 8
// Note that echo BB-ADC cape should be loaded // Note that echo BB-ADC cape should be loaded
#define IIO_ANALOG_IN_DIR "/sys/bus/iio/devices/iio:device0/" #define IIO_ANALOG_IN_DIR "/sys/bus/iio/devices/iio:device0/"
@ -41,7 +39,7 @@ private:
// float _value_ratiometric; // float _value_ratiometric;
uint8_t _sum_count; uint8_t _sum_count;
int16_t _pin; int16_t _pin;
int _pin_fd; int _pin_fd;
int fd_analog_sources[IIO_ANALOG_IN_COUNT]; int fd_analog_sources[IIO_ANALOG_IN_COUNT];
void reopen_pin(void); void reopen_pin(void);
@ -61,4 +59,3 @@ public:
float board_voltage(void) { return 0.0f; } float board_voltage(void) { return 0.0f; }
}; };
#endif // __AP_HAL_IIO_ANALOGIN_H__

Loading…
Cancel
Save