47 lines
1.1 KiB
C++
47 lines
1.1 KiB
C++
/**** Includes ****/
|
|
#include "../utils/utils.h"
|
|
#include "../utils/interpolate.h"
|
|
#include "potentiometer.h"
|
|
|
|
using namespace hw;
|
|
|
|
/**** Private definitions ****/
|
|
/**** Private constants ****/
|
|
/**** Private variables ****/
|
|
/**** Private function declarations ****/
|
|
|
|
/**** Public function definitions ****/
|
|
hw::Potentiometer::Potentiometer(void)
|
|
{
|
|
return;
|
|
}
|
|
|
|
hw::Potentiometer::~Potentiometer(void)
|
|
{
|
|
return;
|
|
}
|
|
|
|
void hw::Potentiometer::init(bsp::AnalogIn* ain_ch, uint16_t low_deadzone, uint16_t high_deadzone)
|
|
{
|
|
this->ain_ch = ain_ch;
|
|
this->low_deadzone = low_deadzone;
|
|
this->high_deadzone = high_deadzone;
|
|
this->last_percent = 0;
|
|
this->update_ain = 1;
|
|
}
|
|
|
|
uint8_t hw::Potentiometer::read(void)
|
|
{
|
|
// Update analog input
|
|
if(this->update_ain) this->ain_ch->read();
|
|
|
|
// Calculate percent
|
|
if(this->ain_ch->last_read <= this->low_deadzone) this->last_percent = 0;
|
|
else if(this->ain_ch->last_read >= this->high_deadzone ) this->last_percent = 100;
|
|
else this->last_percent = util::interpolate(this->ain_ch->last_read, this->low_deadzone, this->high_deadzone, 0, 100);
|
|
|
|
return this->last_percent;
|
|
}
|
|
|
|
/**** Private function definitions ****/
|