qeurothermdevice.cpp

Go to the documentation of this file.

#include "qeurothermdevice.h"
#include "qpidcommport.h"
#include "QTcpSocket"
#include "QTimer"
#include "QThread"
#include "qpiddevicethread.h"

QEurothermDevice::QEurothermDevice(QPidControllerWPtr ctrl, QcepSettingsSaverWPtr saver, QString deviceName) :
  QPidDevice(ctrl, saver, EurothermDevice, deviceName, 1000, 2000),
  m_ObjectNamer(this, "eurotherm"),
  m_Test2State(0),
  m_Test2Count(0)
{
}

void QEurothermDevice::readoutInitial()
{
}

void QEurothermDevice::readoutPolling()
{
}

void QEurothermDevice::readoutTimeout()
{
}

void QEurothermDevice::writeSettings(QSettings *set, QString section)
{
  QPidDevice::writeSettings(set, section+"/eurotherm");

  QcepProperty::writeSettings(this, &staticMetaObject, section+"/eurotherm", set);
}

void QEurothermDevice::readSettings(QSettings *set, QString section)
{
  QPidDevice::readSettings(set, section+"/eurotherm");

  QcepProperty::readSettings(this, &staticMetaObject, section+"/eurotherm", set);
}

void QEurothermDevice::configurationDialog()
{
  if (m_DeviceDialog == NULL) {
    m_DeviceDialog = QEurothermDeviceDialogPtr(new QEurothermDeviceDialog(QEurothermDevicePtr(this)));
  }

  if (m_DeviceDialog) {
    m_DeviceDialog->show();
    m_DeviceDialog->raise();
  }
}

void QEurothermDevice::sendCommand(QString /*cmd*/)
{
}

void QEurothermDevice::changeSetPoint(double /*setPoint*/)
{
  QPidControllerPtr ctl(controller());

  if (ctl) {
//    sendCryoCommand(CSCOMMAND_RAMP, cryoRate(ctl->get_RampRate())+cryoTemperature(setPoint));
  }
}

void QEurothermDevice::changeRampRate(double /*rate*/)
{
}

void QEurothermDevice::changeProportional(double /*prop*/)
{
}

void QEurothermDevice::changeIntegral(double /*integ*/)
{
}

void QEurothermDevice::changeDerivative(double /*deriv*/)
{
}

void QEurothermDevice::enable(bool on)
{
  if (on) {
//    sendCryoCommand(CSCOMMAND_RESTART);
  } else {
//    sendCryoCommand(CSCOMMAND_STOP);
  }
}

bool QEurothermDevice::canAutoTune()
{
  return false;
}

void QEurothermDevice::autoTune()
{
}

QByteArray QEurothermDevice::invertByteArray(QByteArray arr)
{
  QByteArray res;

  foreach(int ch, arr) {
    res.append(ch ^ -1);
  }

  return res;
}

void QEurothermDevice::runTest1()
{
  printMessage("Run test 1");

  QByteArray modbusCommand = QByteArray::fromHex("010741E2");
  QByteArray modbusInverted = invertByteArray(modbusCommand);

  QByteArray bisyncCommand = encodeBiSyncPollCommand(0, 1, 1, "PV");
  QByteArray bisyncInverted = invertByteArray(bisyncCommand);

  int avail;

  for (int i=0; i<50; i++) {
    printMessage(tr("Send iteration %1").arg(i));

    for (int j=0; j<i; j++) {
      commPort()->write(" ");
    }

    commPort()->write(bisyncCommand);
    printMessage(tr("Sent %1").arg(QString(bisyncCommand.toHex())));
    commPort()->waitForBytesWritten();
    QPidDeviceThread::msleep(100);

    for (int j=0; j<i; j++) {
      commPort()->write(" ");
    }

    commPort()->write(bisyncInverted);
    printMessage(tr("Sent %1").arg(QString(bisyncInverted.toHex())));
    commPort()->waitForBytesWritten();
    QPidDeviceThread::msleep(100);

    commPort()->waitForBytesWritten();

    avail = commPort()->bytesAvailable();

    printMessage(tr("%1 bytes of input are available").arg(avail));

    QByteArray res = commPort()->readAll();

    printMessage(tr("Data read - %1").arg(QString(res.toHex())));
  }

  QByteArray inp = commPort()->read(avail);
}

void QEurothermDevice::runTest2()
{
  printMessage("Run test 2");

  if (m_Test2State == 0) {
    connect(&m_Test2Timer, SIGNAL(timeout()), this, SLOT(test2Tick()));

    m_Test2State = 1;
    m_Test2Count = 100;

    m_Test2Timer.start(1000);
  } else {
    m_Test2Timer.stop();

    disconnect(&m_Test2Timer, SIGNAL(timeout()), this, SLOT(test2Tick()));

    m_Test2State = 0;
  }
}

void QEurothermDevice::test2Tick()
{
  if (m_Test2State != 0) {
    if (true) {
      printMessage(tr("Iteration %1").arg(m_Test2Count));

      QByteArray bisyncCommand;

      if (m_Test2Count & 2) {
        bisyncCommand = encodeBiSyncPollCommand(0, 1, 1, "PV");
      } else {
        bisyncCommand = encodeBiSyncSelectCommand(0, 1, 1, "SL", "22.0");
      }

      if (m_Test2Count & 1) {
        bisyncCommand = invertByteArray(bisyncCommand);
      }

      commPort()->write(bisyncCommand);

      commPort()->waitForBytesWritten();
      printMessage(tr("Sent %1").arg(QString(bisyncCommand.toHex())));

      m_Test2Count--;
    }
  }

  int avail = commPort()->bytesAvailable();

  printMessage(tr("%1 bytes of input are available").arg(avail));

  QByteArray res = commPort()->readAll();

  printMessage(tr("Data read - %1").arg(QString(res.toHex())));
}

QByteArray QEurothermDevice::encodeModbusCommand
  (int /*addr*/, int /*cmd*/, QByteArray /*args*/)
{
  QByteArray res;

  return res;
}

QByteArray QEurothermDevice::encodeBiSyncPollCommand
  (int gid, int uid, int chan, QString mne)
{
  QByteArray res;

  res.append(4); // EOT

  QString gidstr = tr("%1").arg(gid,1);
  QString uidstr = tr("%1").arg(uid,1);
  QString chanstr = tr("%1").arg(chan,1);

  res.append(gidstr);
  res.append(gidstr);
  res.append(uidstr);
  res.append(uidstr);
//  res.append(chanstr);
  res.append(mne.left(2));

  res.append(5); // ENQ

  return res;
}

QByteArray QEurothermDevice::encodeBiSyncSelectCommand
  (int gid, int uid, int chan, QString mne, QString val)
{
  QByteArray res;

  res.append(4); // EOT

  QString gidstr = tr("%1").arg(gid,1);
  QString uidstr = tr("%1").arg(uid,1);
  QString chanstr = tr("%1").arg(chan,1);

  res.append(gidstr);
  res.append(gidstr);
  res.append(uidstr);
  res.append(uidstr);

  res.append(2); // STX
//  res.append(chanstr);
  res.append(mne.left(2));
  res.append(val);
  res.append(3); // ETX

  quint32 sum = 0;

  for (int i=6; i<res.length(); i++) {
    sum ^= res[i];
  }

  res.append(sum & 0xff);

  return res;
}