ground/gcs/src/experimental/PowerLog6S/main.cpp

   1 /**
   2  ******************************************************************************
   3  *
   4  * @file       main.cpp
   5  * @author     The OpenPilot Team, http://www.openpilot.org Copyright (C) 2010.
   6  * @see        The GNU Public License (GPL) Version 3
   7  * @brief      Junsi Powerlog utility CLI
   8  *
   9  *****************************************************************************/
  10 /*
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License as published by
  13  * the Free Software Foundation; either version 3 of the License, or
  14  * (at your option) any later version.
  15  *
  16  * This program is distributed in the hope that it will be useful, but
  17  * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
  18  * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
  19  * for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License along
  22  * with this program; if not, write to the Free Software Foundation, Inc.,
  23  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  24  */
  25 #include <QtCore/QCoreApplication>
  26 #include <iostream>
  27 #include <stdio.h>
  28 #include <../../plugins/rawhid/pjrc_rawhid.h>
  29
  30 #define BUF_LEN 64
  31
  32 using namespace std;
  33
  34 typedef unsigned long ULONG; // 4 Bytes
  35 typedef short SHORT;
  36 typedef unsigned short USHORT; // 2 Bytes
  37 typedef unsigned char BYTE; // 1 Byte
  38 typedef unsigned short WORD; // 2 Bytes
  39 typedef unsigned long DWORD; // 4 Bytes
  40
  41
  42 class MyParser : public QObject {
  43     struct POWERLOG_HID_PACK {
  44         BYTE   Len;
  45         BYTE   Type;
  46         DWORD  Interval;
  47         BYTE   LogState;
  48         SHORT  Current;
  49         USHORT Volt;
  50         DWORD  Cap;
  51         SHORT  Cell[6];
  52         USHORT RPM;
  53         SHORT  Temp[4];
  54         USHORT Period;
  55         USHORT Pulse;
  56     };
  57
  58     enum {
  59         TYPE_DATA_ONLINE  = 0x10,
  60         TYPE_DATA_OFFLINE = 0x11,
  61         TYPE_ORDER = 0x20,
  62     };
  63
  64
  65 public:
  66
  67     void start()
  68     {
  69         qDebug() << "Connect a Junsi PowerLog 6S and watch the logging output";
  70         pjrc_rawhid hidHandle;
  71         int numDevices = hidHandle.open(1, 0x0483, 0x5750, 0, 0); // 0xff9c,0x0001);
  72         if (numDevices == 0) {
  73             numDevices = hidHandle.open(1, 0x0483, 0, 0, 0);
  74         }
  75
  76         qDebug() << numDevices << " device(s) opened";
  77
  78         // hidHandle.mytest(0);
  79
  80         char buf[BUF_LEN];
  81         buf[0] = 2;
  82         buf[1] = 0;
  83
  84         cout << "Interval,Current,Volt,Cap,Cell1,Cell2,Cell3,Cell4,Cell5,Cell6,RPM,Temp1,Temp2,Temp3,Temp4,Period,Pulse" << endl;
  85
  86         while (int received = hidHandle.receive(0, buf, BUF_LEN, 3500)) {
  87             ShowInf(buf);
  88         }
  89     }
  90
  91
  92     void ShowInf(char *pBuf)
  93     {
  94         // qDebug() << "--------------------";
  95         POWERLOG_HID_PACK Inf;
  96         int i;
  97         int Count;
  98
  99         Count        = 0;
 100         Inf.Len      = pBuf[Count];
 101         Count       += sizeof(Inf.Len);
 102
 103         Inf.Type     = pBuf[Count];
 104         Count       += sizeof(Inf.Type);
 105
 106         Inf.Interval = *((DWORD *)&pBuf[Count]);
 107         printf("%ld,", Inf.Interval);
 108
 109         Count       += sizeof(Inf.Interval);
 110
 111         Inf.LogState = pBuf[Count];
 112         Count       += sizeof(Inf.LogState);
 113
 114         if (((Inf.Type == TYPE_DATA_ONLINE) || (Inf.Type == TYPE_DATA_OFFLINE)) && (Inf.Len == 0x29)) { // 0x27
 115             Inf.Current = *((SHORT *)&pBuf[Count]);
 116             Count   += sizeof(Inf.Current);
 117             GetShowValue(QString("Current:"), Inf.Current, 5, 2);
 118
 119             Inf.Volt = *((USHORT *)&pBuf[Count]);
 120             Count   += sizeof(Inf.Volt);
 121             GetShowValue(QString("Voltage:"), Inf.Volt, 5, 2);
 122
 123             Inf.Cap  = *((DWORD *)&pBuf[Count]);
 124             Count   += sizeof(Inf.Cap);
 125             GetShowValue(QString("Cap:"), Inf.Cap, 6, 0);
 126
 127             for (i = 0; i < 6; i++) {
 128                 Inf.Cell[i] = *((SHORT *)&pBuf[Count]);
 129                 Count += sizeof(Inf.Cell[i]);
 130             }
 131             GetShowValue(QString("Cell 1:"), Inf.Cell[0], 5, 3);
 132             GetShowValue(QString("Cell 2:"), Inf.Cell[1], 5, 3);
 133             GetShowValue(QString("Cell 3:"), Inf.Cell[2], 5, 3);
 134             GetShowValue(QString("Cell 4:"), Inf.Cell[3], 5, 3);
 135             GetShowValue(QString("Cell 5:"), Inf.Cell[4], 5, 3);
 136             GetShowValue(QString("Cell 6:"), Inf.Cell[5], 5, 3);
 137
 138             Inf.RPM = *((USHORT *)&pBuf[Count]);
 139             Count  += sizeof(Inf.RPM);
 140             GetShowValue(QString("RPM:"), Inf.RPM, 6, 0);
 141
 142
 143             for (i = 0; i < 4; i++) {
 144                 Inf.Temp[i] = *((SHORT *)&pBuf[Count]);
 145                 Count += sizeof(Inf.Temp[i]);
 146             }
 147             GetShowValue(QString("Int Temp1:"), Inf.Temp[0], 4, 1);
 148             if (Inf.Temp[1] == 0x7fff) {
 149                 QString txtExtTemp1 = QString("NULL");
 150             } else {
 151                 GetShowValue(QString("Ext temp1:"), Inf.Temp[1], 4, 1);
 152             }
 153             if (Inf.Temp[2] == 0x7fff) {
 154                 QString txtExtTemp2 = QString("NULL");
 155             } else {
 156                 GetShowValue(QString("Ext temp2:"), Inf.Temp[2], 4, 1);
 157             }
 158             if (Inf.Temp[3] == 0x7fff) {
 159                 QString txtExtTemp3 = QString("NULL");
 160             } else {
 161                 GetShowValue(QString("Ext temp3:"), Inf.Temp[3], 4, 1);
 162             }
 163
 164             Inf.Period = *((USHORT *)&pBuf[Count]);
 165             Count    += sizeof(Inf.Period);
 166             GetShowValue(QString("Period:"), Inf.Period, 6, 0);
 167
 168             Inf.Pulse = *((USHORT *)&pBuf[Count]);
 169             Count    += sizeof(Inf.Pulse);
 170             GetShowValue(QString("Pulse:"), Inf.Pulse, 6, 0);
 171
 172             printf("\n");
 173         }
 174     }
 175
 176     void GetShowValue(QString label, DWORD Value, WORD Len, WORD Dot)
 177     {
 178         // cout << label .toStdString() << " ";
 179
 180         if (Value < 0) {
 181             Value = -Value;
 182             if (Dot == 1) {
 183                 printf("-%ld.%01lu", Value / 10, Value % 10);
 184             } else if (Dot == 2) {
 185                 printf("-%ld.%02lu", Value / 100, Value % 100);
 186             } else if (Dot == 3) {
 187                 printf("-%ld.%03lu", Value / 1000, Value % 1000);
 188             } else if (Dot == 4) {
 189                 printf("-%ld.%04lu", Value / 10000, Value % 10000);
 190             } else {
 191                 printf("-%ld", Value);
 192             }
 193         } else {
 194             if (Dot == 1) {
 195                 printf("%ld.%01lu", Value / 10, Value % 10);
 196             } else if (Dot == 2) {
 197                 printf("%ld.%02lu", Value / 100, Value % 100);
 198             } else if (Dot == 3) {
 199                 printf("%ld.%03lu", Value / 1000, Value % 1000);
 200             } else if (Dot == 4) {
 201                 printf("%ld.%04lu", Value / 10000, Value % 10000);
 202             } else {
 203                 printf("%ld", Value);
 204             }
 205         }
 206         printf(",");
 207     }
 208 };
 209
 210
 211 int main(int argc, char *argv[])
 212 {
 213     QCoreApplication a(argc, argv);
 214     MyParser b;
 215
 216     b.start();
 217
 218 // return a.exec();
 219 }