|
|
|
@ -2,8 +2,7 @@
@@ -2,8 +2,7 @@
|
|
|
|
|
|
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_LINUX |
|
|
|
|
|
|
|
|
|
#include <stdio.h> |
|
|
|
|
#include "RaspilotAnalogIn.h" |
|
|
|
|
#include "AnalogIn_Raspilot.h" |
|
|
|
|
#include "px4io_protocol.h" |
|
|
|
|
|
|
|
|
|
#define RASPILOT_ANALOGIN_DEBUG 0 |
|
|
|
@ -16,13 +15,13 @@
@@ -16,13 +15,13 @@
|
|
|
|
|
#define error(fmt, args ...) |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
RaspilotAnalogSource::RaspilotAnalogSource(int16_t pin): |
|
|
|
|
AnalogSource_Raspilot::AnalogSource_Raspilot(int16_t pin): |
|
|
|
|
_pin(pin), |
|
|
|
|
_value(0.0f) |
|
|
|
|
{ |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void RaspilotAnalogSource::set_pin(uint8_t pin) |
|
|
|
|
void AnalogSource_Raspilot::set_pin(uint8_t pin) |
|
|
|
|
{ |
|
|
|
|
if (_pin == pin) { |
|
|
|
|
return; |
|
|
|
@ -30,27 +29,27 @@ void RaspilotAnalogSource::set_pin(uint8_t pin)
@@ -30,27 +29,27 @@ void RaspilotAnalogSource::set_pin(uint8_t pin)
|
|
|
|
|
_pin = pin; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
float RaspilotAnalogSource::read_average() |
|
|
|
|
float AnalogSource_Raspilot::read_average() |
|
|
|
|
{ |
|
|
|
|
return read_latest(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
float RaspilotAnalogSource::read_latest() |
|
|
|
|
float AnalogSource_Raspilot::read_latest() |
|
|
|
|
{ |
|
|
|
|
return _value; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
float RaspilotAnalogSource::voltage_average() |
|
|
|
|
float AnalogSource_Raspilot::voltage_average() |
|
|
|
|
{ |
|
|
|
|
return _value; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
float RaspilotAnalogSource::voltage_latest() |
|
|
|
|
float AnalogSource_Raspilot::voltage_latest() |
|
|
|
|
{ |
|
|
|
|
return _value; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
float RaspilotAnalogSource::voltage_average_ratiometric() |
|
|
|
|
float AnalogSource_Raspilot::voltage_average_ratiometric() |
|
|
|
|
{ |
|
|
|
|
return _value; |
|
|
|
|
} |
|
|
|
@ -74,7 +73,7 @@ AP_HAL::AnalogSource* RaspilotAnalogIn::channel(int16_t pin)
@@ -74,7 +73,7 @@ AP_HAL::AnalogSource* RaspilotAnalogIn::channel(int16_t pin)
|
|
|
|
|
{ |
|
|
|
|
for (uint8_t j = 0; j < _channels_number; j++) { |
|
|
|
|
if (_channels[j] == NULL) { |
|
|
|
|
_channels[j] = new RaspilotAnalogSource(pin); |
|
|
|
|
_channels[j] = new AnalogSource_Raspilot(pin); |
|
|
|
|
return _channels[j]; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
@ -123,6 +122,12 @@ void RaspilotAnalogIn::_update()
@@ -123,6 +122,12 @@ void RaspilotAnalogIn::_update()
|
|
|
|
|
|
|
|
|
|
hal.scheduler->delay_microseconds(200); |
|
|
|
|
|
|
|
|
|
count = 0; |
|
|
|
|
_dma_packet_tx.count_code = count | PKT_CODE_READ; |
|
|
|
|
_dma_packet_tx.page = 0; |
|
|
|
|
_dma_packet_tx.offset = 0; |
|
|
|
|
_dma_packet_tx.crc = 0; |
|
|
|
|
_dma_packet_tx.crc = crc_packet(&_dma_packet_tx); |
|
|
|
|
/* get reg4 data from raspilotio */ |
|
|
|
|
_spi->transaction((uint8_t *)&_dma_packet_tx, (uint8_t *)&_dma_packet_rx, sizeof(_dma_packet_tx)); |
|
|
|
|
|
|
|
|
@ -130,7 +135,7 @@ void RaspilotAnalogIn::_update()
@@ -130,7 +135,7 @@ void RaspilotAnalogIn::_update()
|
|
|
|
|
|
|
|
|
|
for (int16_t i = 0; i < RASPILOT_ADC_MAX_CHANNELS; i++) { |
|
|
|
|
for (int16_t j=0; j < RASPILOT_ADC_MAX_CHANNELS; j++) { |
|
|
|
|
RaspilotAnalogSource *source = _channels[j]; |
|
|
|
|
AnalogSource_Raspilot *source = _channels[j]; |
|
|
|
|
|
|
|
|
|
if (source != NULL && i == source->_pin) { |
|
|
|
|
source->_value = _dma_packet_rx.regs[i] * 3.3 / 4096.0; |