Subversion Repositories Projects

Compare Revisions

Ignore whitespace Rev 673 → Rev 674

/QMK-Groundstation/trunk/QMK-Settings/Dialogs/dlg_MotorMixer.cpp
0,0 → 1,367
/***************************************************************************
* Copyright (C) 2009 by Manuel Schrape *
* manuel.schrape@gmx.de *
* *
* This program is free software; you can redistribute it and/or modify *
* it under the terms of the GNU General Public License as published by *
* the Free Software Foundation; either version 2 of the License. *
* *
* This program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, write to the *
* Free Software Foundation, Inc., *
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
***************************************************************************/
#include "dlg_MotorMixer.h"
 
dlg_MotorMixer::dlg_MotorMixer(QWidget *parent) : QDialog(parent)
{
setupUi(this);
connect(pb_READ, SIGNAL(clicked()), this, SLOT(slot_pb_READ()));
connect(pb_LOAD, SIGNAL(clicked()), this, SLOT(slot_pb_LOAD()));
connect(pb_SAVE, SIGNAL(clicked()), this, SLOT(slot_pb_SAVE()));
connect(pb_WRITE, SIGNAL(clicked()), this, SLOT(slot_pb_WRITE()));
 
connect(sb_NICK_1, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_2, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_3, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_4, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_5, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_6, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_7, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_8, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_9, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_10, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_11, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_NICK_12, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
 
connect(sb_ROLL_1, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_2, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_3, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_4, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_5, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_6, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_7, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_8, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_9, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_10, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_11, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_ROLL_12, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
 
connect(sb_GIER_1, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_2, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_3, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_4, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_5, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_6, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_7, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_8, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_9, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_10, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_11, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
connect(sb_GIER_12, SIGNAL(valueChanged(int)), this, SLOT(slot_CheckValue(int)));
 
}
 
// Connection-Object übergeben.
void dlg_MotorMixer::set_Objects(Input *t_Input, cSettings *t_Settings, s_Directorys t_Dir)
{
o_Input = t_Input;
o_Settings = t_Settings;
s_Dir = t_Dir;
}
 
// Motordaten übernehmen.
void dlg_MotorMixer::set_MotorConfig(s_MK_Mixer t_Mixer)
{
MK_Mixer = t_Mixer;
 
set_MotorData();
}
 
// Motordaten aus GUI übernehmen
void dlg_MotorMixer::get_MotorData()
{
memcpy(MK_Mixer.Name, le_NAME->text().toLatin1().data(), 12);
 
MK_Mixer.Motor[0][0] = sb_GAS_1->value();
MK_Mixer.Motor[1][0] = sb_GAS_2->value();
MK_Mixer.Motor[2][0] = sb_GAS_3->value();
MK_Mixer.Motor[3][0] = sb_GAS_4->value();
MK_Mixer.Motor[4][0] = sb_GAS_5->value();
MK_Mixer.Motor[5][0] = sb_GAS_6->value();
MK_Mixer.Motor[6][0] = sb_GAS_7->value();
MK_Mixer.Motor[7][0] = sb_GAS_8->value();
MK_Mixer.Motor[8][0] = sb_GAS_9->value();
MK_Mixer.Motor[9][0] = sb_GAS_10->value();
MK_Mixer.Motor[10][0] = sb_GAS_11->value();
MK_Mixer.Motor[11][0] = sb_GAS_12->value();
 
MK_Mixer.Motor[0][1] = sb_NICK_1->value();
MK_Mixer.Motor[1][1] = sb_NICK_2->value();
MK_Mixer.Motor[2][1] = sb_NICK_3->value();
MK_Mixer.Motor[3][1] = sb_NICK_4->value();
MK_Mixer.Motor[4][1] = sb_NICK_5->value();
MK_Mixer.Motor[5][1] = sb_NICK_6->value();
MK_Mixer.Motor[6][1] = sb_NICK_7->value();
MK_Mixer.Motor[7][1] = sb_NICK_8->value();
MK_Mixer.Motor[8][1] = sb_NICK_9->value();
MK_Mixer.Motor[9][1] = sb_NICK_10->value();
MK_Mixer.Motor[10][1] = sb_NICK_11->value();
MK_Mixer.Motor[11][1] = sb_NICK_12->value();
 
MK_Mixer.Motor[0][2] = sb_ROLL_1->value();
MK_Mixer.Motor[1][2] = sb_ROLL_2->value();
MK_Mixer.Motor[2][2] = sb_ROLL_3->value();
MK_Mixer.Motor[3][2] = sb_ROLL_4->value();
MK_Mixer.Motor[4][2] = sb_ROLL_5->value();
MK_Mixer.Motor[5][2] = sb_ROLL_6->value();
MK_Mixer.Motor[6][2] = sb_ROLL_7->value();
MK_Mixer.Motor[7][2] = sb_ROLL_8->value();
MK_Mixer.Motor[8][2] = sb_ROLL_9->value();
MK_Mixer.Motor[9][2] = sb_ROLL_10->value();
MK_Mixer.Motor[10][2] = sb_ROLL_11->value();
MK_Mixer.Motor[11][2] = sb_ROLL_12->value();
 
MK_Mixer.Motor[0][3] = sb_GIER_1->value();
MK_Mixer.Motor[1][3] = sb_GIER_2->value();
MK_Mixer.Motor[2][3] = sb_GIER_3->value();
MK_Mixer.Motor[3][3] = sb_GIER_4->value();
MK_Mixer.Motor[4][3] = sb_GIER_5->value();
MK_Mixer.Motor[5][3] = sb_GIER_6->value();
MK_Mixer.Motor[6][3] = sb_GIER_7->value();
MK_Mixer.Motor[7][3] = sb_GIER_8->value();
MK_Mixer.Motor[8][3] = sb_GIER_9->value();
MK_Mixer.Motor[9][3] = sb_GIER_10->value();
MK_Mixer.Motor[10][3] = sb_GIER_11->value();
MK_Mixer.Motor[11][3] = sb_GIER_12->value();
}
 
// Motordaten anzeigen
void dlg_MotorMixer::set_MotorData()
{
le_NAME->setText(QString(MK_Mixer.Name));
 
sb_GAS_1->setValue(MK_Mixer.Motor[0][0]);
sb_GAS_2->setValue(MK_Mixer.Motor[1][0]);
sb_GAS_3->setValue(MK_Mixer.Motor[2][0]);
sb_GAS_4->setValue(MK_Mixer.Motor[3][0]);
sb_GAS_5->setValue(MK_Mixer.Motor[4][0]);
sb_GAS_6->setValue(MK_Mixer.Motor[5][0]);
sb_GAS_7->setValue(MK_Mixer.Motor[6][0]);
sb_GAS_8->setValue(MK_Mixer.Motor[7][0]);
sb_GAS_9->setValue(MK_Mixer.Motor[8][0]);
sb_GAS_10->setValue(MK_Mixer.Motor[9][0]);
sb_GAS_11->setValue(MK_Mixer.Motor[10][0]);
sb_GAS_12->setValue(MK_Mixer.Motor[11][0]);
 
sb_NICK_1->setValue(MK_Mixer.Motor[0][1]);
sb_NICK_2->setValue(MK_Mixer.Motor[1][1]);
sb_NICK_3->setValue(MK_Mixer.Motor[2][1]);
sb_NICK_4->setValue(MK_Mixer.Motor[3][1]);
sb_NICK_5->setValue(MK_Mixer.Motor[4][1]);
sb_NICK_6->setValue(MK_Mixer.Motor[5][1]);
sb_NICK_7->setValue(MK_Mixer.Motor[6][1]);
sb_NICK_8->setValue(MK_Mixer.Motor[7][1]);
sb_NICK_9->setValue(MK_Mixer.Motor[8][1]);
sb_NICK_10->setValue(MK_Mixer.Motor[9][1]);
sb_NICK_11->setValue(MK_Mixer.Motor[10][1]);
sb_NICK_12->setValue(MK_Mixer.Motor[11][1]);
 
sb_ROLL_1->setValue(MK_Mixer.Motor[0][2]);
sb_ROLL_2->setValue(MK_Mixer.Motor[1][2]);
sb_ROLL_3->setValue(MK_Mixer.Motor[2][2]);
sb_ROLL_4->setValue(MK_Mixer.Motor[3][2]);
sb_ROLL_5->setValue(MK_Mixer.Motor[4][2]);
sb_ROLL_6->setValue(MK_Mixer.Motor[5][2]);
sb_ROLL_7->setValue(MK_Mixer.Motor[6][2]);
sb_ROLL_8->setValue(MK_Mixer.Motor[7][2]);
sb_ROLL_9->setValue(MK_Mixer.Motor[8][2]);
sb_ROLL_10->setValue(MK_Mixer.Motor[9][2]);
sb_ROLL_11->setValue(MK_Mixer.Motor[10][2]);
sb_ROLL_12->setValue(MK_Mixer.Motor[11][2]);
 
sb_GIER_1->setValue(MK_Mixer.Motor[0][3]);
sb_GIER_2->setValue(MK_Mixer.Motor[1][3]);
sb_GIER_3->setValue(MK_Mixer.Motor[2][3]);
sb_GIER_4->setValue(MK_Mixer.Motor[3][3]);
sb_GIER_5->setValue(MK_Mixer.Motor[4][3]);
sb_GIER_6->setValue(MK_Mixer.Motor[5][3]);
sb_GIER_7->setValue(MK_Mixer.Motor[6][3]);
sb_GIER_8->setValue(MK_Mixer.Motor[7][3]);
sb_GIER_9->setValue(MK_Mixer.Motor[8][3]);
sb_GIER_10->setValue(MK_Mixer.Motor[9][3]);
sb_GIER_11->setValue(MK_Mixer.Motor[10][3]);
sb_GIER_12->setValue(MK_Mixer.Motor[11][3]);
}
 
// Prüfen auf vollstaändigkeit
void dlg_MotorMixer::slot_CheckValue(int Wert)
{
Wert = Wert;
 
int NICK = sb_NICK_1->value() + sb_NICK_2->value() + sb_NICK_3->value() + sb_NICK_4->value() + sb_NICK_5->value() + sb_NICK_6->value() +
sb_NICK_7->value() + sb_NICK_8->value() + sb_NICK_9->value() + sb_NICK_10->value() + sb_NICK_11->value() + sb_NICK_12->value();
 
int ROLL = sb_ROLL_1->value() + sb_ROLL_2->value() + sb_ROLL_3->value() + sb_ROLL_4->value() + sb_ROLL_5->value() + sb_ROLL_6->value() +
sb_ROLL_7->value() + sb_ROLL_8->value() + sb_ROLL_9->value() + sb_ROLL_10->value() + sb_ROLL_11->value() + sb_ROLL_12->value();
 
int GIER = sb_GIER_1->value() + sb_GIER_2->value() + sb_GIER_3->value() + sb_GIER_4->value() + sb_GIER_5->value() + sb_GIER_6->value() +
sb_GIER_7->value() + sb_GIER_8->value() + sb_GIER_9->value() + sb_GIER_10->value() + sb_GIER_11->value() + sb_GIER_12->value();
 
if (NICK == 0)
{
lb_NICK->setEnabled(true);
}
else
{
lb_NICK->setEnabled(false);
}
 
if (ROLL == 0)
{
lb_ROLL->setEnabled(true);
}
else
{
lb_ROLL->setEnabled(false);
}
 
if (GIER == 0)
{
lb_GIER->setEnabled(true);
}
else
{
lb_GIER->setEnabled(false);
}
}
 
// Mixer von der FC Lesen.
void dlg_MotorMixer::read_Mixer()
{
c_Data[0] = 0;
o_Input->send_Data(HandlerMK::make_Frame('n', ADDRESS_FC, c_Data, 0).toLatin1().data(), DATA_READ_MIXER);
}
 
// Button-Slots
void dlg_MotorMixer::slot_pb_READ()
{
read_Mixer();
}
 
void dlg_MotorMixer::slot_pb_WRITE()
{
get_MotorData();
 
memcpy((unsigned char *)&c_Data, (unsigned char *)&MK_Mixer, sizeof(MK_Mixer));
 
o_Input->send_Data(HandlerMK::make_Frame('m', ADDRESS_FC, c_Data, sizeof(MK_Mixer)).toLatin1().data(), DATA_WRITE_MIXER);
}
 
void dlg_MotorMixer::slot_pb_LOAD()
{
QString Dir = QDir::homePath();
 
QString Filename = QFileDialog::getOpenFileName(this, tr("Mikrokopter MotorMixer laden"), s_Dir.Settings + "", tr("MK MotorMixer(*.mkm);;Alle Dateien (*)"));
 
if (!Filename.isEmpty())
{
QSettings Setting(Filename, QSettings::IniFormat);
 
Setting.beginGroup("Info");
memcpy(MK_Mixer.Name, Setting.value("Name", QString("--noname--")).toString().toLatin1().data(), 12);
MK_Mixer.Revision = Setting.value("Version", 0).toInt();
Setting.endGroup();
 
Setting.beginGroup("Gas");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
MK_Mixer.Motor[z][0] = Setting.value(QString("Motor%1").arg(z+1), 0).toInt();
}
Setting.endGroup();
 
Setting.beginGroup("Nick");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
MK_Mixer.Motor[z][1] = Setting.value(QString("Motor%1").arg(z+1), 0).toInt();
}
Setting.endGroup();
 
Setting.beginGroup("Roll");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
MK_Mixer.Motor[z][2] = Setting.value(QString("Motor%1").arg(z+1), 0).toInt();
}
Setting.endGroup();
 
Setting.beginGroup("Yaw");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
MK_Mixer.Motor[z][3] = Setting.value(QString("Motor%1").arg(z+1), 0).toInt();
}
Setting.endGroup();
 
if (MK_Mixer.Revision == MK_VERSION_MIXER)
{
set_MotorData();
}
}
}
 
void dlg_MotorMixer::slot_pb_SAVE()
{
QString Dir = QDir::homePath();
 
QString Filename = QFileDialog::getSaveFileName(this, tr("Mikrokopter MotorMixer speichern"), s_Dir.Settings + "/" + le_NAME->text(), tr("MK MotorMixer(*.mkm);;Alle Dateien (*)"));
 
if (!Filename.isEmpty())
{
if (!(Filename.endsWith(".mkm", Qt::CaseInsensitive)))
{
Filename = Filename + QString(".mkm");
}
 
get_MotorData();
 
QSettings Setting(Filename, QSettings::IniFormat);
 
Setting.beginGroup("Info");
Setting.setValue("Name", QString(MK_Mixer.Name));
Setting.setValue("Version", MK_VERSION_MIXER);
Setting.endGroup();
 
Setting.beginGroup("Gas");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
Setting.setValue(QString("Motor%1").arg(z+1), MK_Mixer.Motor[z][0]);
}
Setting.endGroup();
 
Setting.beginGroup("Nick");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
Setting.setValue(QString("Motor%1").arg(z+1), MK_Mixer.Motor[z][1]);
}
Setting.endGroup();
 
Setting.beginGroup("Roll");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
Setting.setValue(QString("Motor%1").arg(z+1), MK_Mixer.Motor[z][2]);
}
Setting.endGroup();
 
Setting.beginGroup("Yaw");
for (int z = 0; z < MK_MAX_MOTOR; z++)
{
Setting.setValue(QString("Motor%1").arg(z+1), MK_Mixer.Motor[z][3]);
}
Setting.endGroup();
}
}