BatteryMonitorConfig.cc 9.55 KB
Newer Older
1
#include "BatteryMonitorConfig.h"
2
#include <QMessageBox>
3

4
BatteryMonitorConfig::BatteryMonitorConfig(QWidget *parent) : AP2ConfigWidget(parent)
5 6
{
    ui.setupUi(this);
7 8 9
    ui.monitorComboBox->addItem(tr("0: Disabled"));
    ui.monitorComboBox->addItem(tr("3: Battery Volts"));
    ui.monitorComboBox->addItem(tr("4: Voltage and Current"));
10

11
    ui.sensorComboBox->addItem(tr("0: Other"));
12 13 14 15 16 17 18 19 20
    ui.sensorComboBox->addItem("1: AttoPilot 45A");
    ui.sensorComboBox->addItem("2: AttoPilot 90A");
    ui.sensorComboBox->addItem("3: AttoPilot 180A");
    ui.sensorComboBox->addItem("4: 3DR Power Module");

    ui.apmVerComboBox->addItem("0: APM1");
    ui.apmVerComboBox->addItem("1: APM2 - 2.5 non 3DR");
    ui.apmVerComboBox->addItem("2: APM2.5 - 3DR Power Module");
    ui.apmVerComboBox->addItem("3: PX4");
21 22

    ui.alertOnLowCheckBox->setVisible(false); //Unimpelemented, but TODO.
23

24 25 26 27 28 29 30 31 32

    connect(ui.monitorComboBox,SIGNAL(currentIndexChanged(int)),this,SLOT(monitorCurrentIndexChanged(int)));
    connect(ui.sensorComboBox,SIGNAL(currentIndexChanged(int)),this,SLOT(sensorCurrentIndexChanged(int)));
    connect(ui.apmVerComboBox,SIGNAL(currentIndexChanged(int)),this,SLOT(apmVerCurrentIndexChanged(int)));

    connect(ui.calcDividerLineEdit,SIGNAL(editingFinished()),this,SLOT(calcDividerSet()));
    connect(ui.ampsPerVoltsLineEdit,SIGNAL(editingFinished()),this,SLOT(ampsPerVoltSet()));
    connect(ui.battCapacityLineEdit,SIGNAL(editingFinished()),this,SLOT(batteryCapacitySet()));

33

34
    initConnections();
35
}
36 37
void BatteryMonitorConfig::activeUASSet(UASInterface *uas)
{
38 39 40 41 42
    if (m_uas)
    {
        disconnect(m_uas,SIGNAL(batteryChanged(UASInterface*,double,double,double,int)),this,SLOT(batteryChanged(UASInterface*,double,double,double,int)));
    }
    AP2ConfigWidget::activeUASSet(uas);
43 44 45 46 47
    if (!uas)
    {
        return;
    }
    connect(uas,SIGNAL(batteryChanged(UASInterface*,double,double,double,int)),this,SLOT(batteryChanged(UASInterface*,double,double,double,int)));
48

49
}
50 51 52
void BatteryMonitorConfig::alertOnLowClicked(bool checked)
{
}
53

54 55
void BatteryMonitorConfig::calcDividerSet()
{
56 57
    if (!m_uas)
    {
58
        showNullMAVErrorMessageBox();
59 60
        return;
    }
61 62 63 64 65 66 67 68
    bool ok = false;
    float newval = ui.calcDividerLineEdit->text().toFloat(&ok);
    if (!ok)
    {
        //Error parsing;
        QMessageBox::information(0,"Error","Invalid number entered for voltage divider. Please try again");
        return;
    }
69
    m_uas->getParamManager()->setParameter(1,"VOLT_DIVIDER",newval);
70 71 72
}
void BatteryMonitorConfig::ampsPerVoltSet()
{
73 74
    if (!m_uas)
    {
75
        showNullMAVErrorMessageBox();
76 77
        return;
    }
78 79 80 81 82 83 84 85
    bool ok = false;
    float newval = ui.ampsPerVoltsLineEdit->text().toFloat(&ok);
    if (!ok)
    {
        //Error parsing;
        QMessageBox::information(0,"Error","Invalid number entered for amps per volts. Please try again");
        return;
    }
86
    m_uas->getParamManager()->setParameter(1,"AMPS_PER_VOLT",newval);
87 88 89
}
void BatteryMonitorConfig::batteryCapacitySet()
{
90 91
    if (!m_uas)
    {
92
        showNullMAVErrorMessageBox();
93 94
        return;
    }
95 96 97 98 99 100 101 102
    bool ok = false;
    float newval = ui.battCapacityLineEdit->text().toFloat(&ok);
    if (!ok)
    {
        //Error parsing;
        QMessageBox::information(0,"Error","Invalid number entered for amps per volts. Please try again");
        return;
    }
103
    m_uas->getParamManager()->setParameter(1,"BATT_CAPACITY",newval);
104 105 106 107 108 109
}

void BatteryMonitorConfig::monitorCurrentIndexChanged(int index)
{
    if (!m_uas)
    {
110
        showNullMAVErrorMessageBox();
111 112
        return;
    }
113
    if (index == 0) //Battery Monitor Disabled
114
    {
115 116 117
        m_uas->getParamManager()->setParameter(1,"BATT_VOLT_PIN",-1);
        m_uas->getParamManager()->setParameter(1,"BATT_CURR_PIN",-1);
        m_uas->getParamManager()->setParameter(1,"BATT_MONITOR",0);
118 119 120 121 122 123 124 125
        ui.sensorComboBox->setEnabled(false);
        ui.apmVerComboBox->setEnabled(false);
        ui.measuredVoltsLineEdit->setEnabled(false);
        ui.measuredVoltsLineEdit->setEnabled(false);
        ui.calcDividerLineEdit->setEnabled(false);
        ui.calcVoltsLineEdit->setEnabled(false);
        ui.ampsPerVoltsLineEdit->setEnabled(false);
    }
126
    else if (index == 1) //Monitor voltage only
127
    {
128
        m_uas->getParamManager()->setParameter(1,"BATT_MONITOR",3);
129 130 131 132 133 134 135
        ui.sensorComboBox->setEnabled(false);
        ui.apmVerComboBox->setEnabled(true);
        ui.measuredVoltsLineEdit->setEnabled(true);
        ui.calcDividerLineEdit->setEnabled(true);
        ui.calcVoltsLineEdit->setEnabled(false);
        ui.ampsPerVoltsLineEdit->setEnabled(false);
    }
136
    else if (index == 2) //Monitor voltage and current
137
    {
138
        m_uas->getParamManager()->setParameter(1,"BATT_MONITOR",4);
139 140 141 142 143 144 145 146 147 148 149 150
        ui.sensorComboBox->setEnabled(true);
        ui.apmVerComboBox->setEnabled(true);
        ui.measuredVoltsLineEdit->setEnabled(true);
        ui.calcDividerLineEdit->setEnabled(true);
        ui.calcVoltsLineEdit->setEnabled(false);
        ui.ampsPerVoltsLineEdit->setEnabled(true);
    }


}
void BatteryMonitorConfig::sensorCurrentIndexChanged(int index)
{
151 152 153 154 155 156
    float maxvolt = 0.0;
    float maxamps = 0.0;
    float mvpervolt = 0.0;
    float mvperamp = 0.0;
    float topvolt = 0.0;
    float topamps = 0.0;
157 158 159

    if (index == 1)
    {
160
        //atto 45 see https://www.sparkfun.com/products/10643
161 162 163 164 165
        maxvolt = 13.6;
        maxamps = 44.7;
    }
    else if (index == 2)
    {
166 167
        //atto 90 see https://www.sparkfun.com/products/9028
        maxvolt = 51.8;
168 169 170 171
        maxamps = 89.4;
    }
    else if (index == 3)
    {
172 173
        //atto 180 see https://www.sparkfun.com/products/10644
        maxvolt = 51.8;
174 175 176 177 178
        maxamps = 178.8;
    }
    else if (index == 4)
    {
        //3dr
179 180
        maxvolt = 50.0;
        maxamps = 90.0;
181
    }
182 183
    mvpervolt = calculatemVPerVolt(3.3,maxvolt);
    mvperamp = calculatemVPerAmp(3.3,maxamps);
184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
    if (index == 0)
    {
        //Other
        ui.ampsPerVoltsLineEdit->setEnabled(true);
        ui.calcDividerLineEdit->setEnabled(true);
        ui.measuredVoltsLineEdit->setEnabled(true);
    }
    else
    {
        topvolt = (maxvolt * mvpervolt) / 1000.0;
        topamps = (maxamps * mvperamp) / 1000.0;

        ui.calcDividerLineEdit->setText(QString::number(maxvolt/topvolt));
        ui.ampsPerVoltsLineEdit->setText(QString::number(maxamps / topamps));
        ui.ampsPerVoltsLineEdit->setEnabled(false);
        ui.calcDividerLineEdit->setEnabled(false);
        ui.measuredVoltsLineEdit->setEnabled(false);
    }
}
203 204 205 206 207 208 209 210 211
float BatteryMonitorConfig::calculatemVPerAmp(float maxvoltsout,float maxamps)
{
    return (1000.0 * (maxvoltsout/maxamps));
}

float BatteryMonitorConfig::calculatemVPerVolt(float maxvoltsout,float maxvolts)
{
    return (1000.0 * (maxvoltsout/maxvolts));
}
212 213 214

void BatteryMonitorConfig::apmVerCurrentIndexChanged(int index)
{
215 216
    if (!m_uas)
    {
217
        showNullMAVErrorMessageBox();
218 219 220 221
        return;
    }
    if (index == 0) //APM1
    {
222 223
        m_uas->getParamManager()->setParameter(1,"BATT_VOLT_PIN",0);
        m_uas->getParamManager()->setParameter(1,"BATT_CURR_PIN",1);
224 225 226
    }
    else if (index == 1) //APM2
    {
227 228
        m_uas->getParamManager()->setParameter(1,"BATT_VOLT_PIN",1);
        m_uas->getParamManager()->setParameter(1,"BATT_CURR_PIN",2);
229 230 231
    }
    else if (index == 2) //APM2.5
    {
232 233
        m_uas->getParamManager()->setParameter(1,"BATT_VOLT_PIN",13);
        m_uas->getParamManager()->setParameter(1,"BATT_CURR_PIN",12);
234 235 236
    }
    else if (index == 3) //PX4
    {
237 238 239
        m_uas->getParamManager()->setParameter(1,"BATT_VOLT_PIN",100);
        m_uas->getParamManager()->setParameter(1,"BATT_CURR_PIN",101);
        m_uas->getParamManager()->setParameter(1,"VOLT_DIVIDER",1);
240 241
        ui.calcDividerLineEdit->setText("1");
    }
242 243 244 245 246
}

BatteryMonitorConfig::~BatteryMonitorConfig()
{
}
247 248 249 250 251 252 253 254
void BatteryMonitorConfig::batteryChanged(UASInterface* uas, double voltage, double current, double percent, int seconds)
{
    ui.calcVoltsLineEdit->setText(QString::number(voltage,'f',2));
    if (ui.measuredVoltsLineEdit->text() == "")
    {
        ui.measuredVoltsLineEdit->setText(ui.calcVoltsLineEdit->text());
    }
}
255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311

void BatteryMonitorConfig::parameterChanged(int uas, int component, QString parameterName, QVariant value)
{
    if (parameterName == "VOLT_DIVIDER")
    {
        ui.calcDividerLineEdit->setText(QString::number(value.toFloat(),'f',4));
    }
    else if (parameterName == "AMP_PER_VOLT")
    {
        ui.ampsPerVoltsLineEdit->setText(QString::number(value.toFloat(),'g',2));

    }
    else if (parameterName == "BATT_MONITOR")
    {
        if (value.toInt() == 0) //0: Disable
        {
            ui.monitorComboBox->setCurrentIndex(0);
        }
        else if (value.toInt() == 3) //3: Battery volts
        {
            ui.monitorComboBox->setCurrentIndex(1);
        }
        else if (value.toInt() == 4) //4: Voltage and Current
        {
            ui.monitorComboBox->setCurrentIndex(2);
        }

    }
    else if (parameterName == "BATT_CAPACITY")
    {
        ui.battCapacityLineEdit->setText(QString::number(value.toFloat()));
    }
    else if (parameterName == "BATT_VOLT_PIN")
    {
        int ivalue = value.toInt();
        if (ivalue == 0) //APM1
        {
            ui.apmVerComboBox->setCurrentIndex(0);
        }
        else if (ivalue == 1) //APM2
        {
            ui.apmVerComboBox->setCurrentIndex(1);
        }
        else if (ivalue == 13) //APM2.5
        {
            ui.apmVerComboBox->setCurrentIndex(2);
        }
        else if (ivalue == 100) //PX4
        {
            ui.apmVerComboBox->setCurrentIndex(3);
        }
    }
    else if (parameterName == "BATT_CURR_PIN")
    {
        //Unused at the moment, everything is off BATT_VOLT_PIN
    }
}