Arduino-FOC-drivers/src/comms/telemetry/SimpleTelemetry.cpp at master · Santynolo/Arduino-FOC-drivers · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42

#include "./SimpleTelemetry.h"


SimpleTelemetry::SimpleTelemetry(){
};


SimpleTelemetry::~SimpleTelemetry(){
    // nothing to do here
};


void SimpleTelemetry::init(TextIO& _comms){
    this->Telemetry::init(_comms);
};


void SimpleTelemetry::sendTelemetry(){
    if (numRegisters > 0) {
        for (uint8_t i = 0; i < numRegisters; i++) {
            SimpleFOCRegisters::regs->registerToComms(*comms, registers[i], motors[registers_motor[i]]);
            if (i<numRegisters-1) *comms << '\t';
        };
        *comms << '\n';
    }
};


void SimpleTelemetry::sendHeader(){
    if (numRegisters > 0) {
        for (uint8_t i = 0; i < numRegisters; i++) {
            *comms << 'R';
            if (registers_motor[i] != 0) {
                *comms << registers_motor[i] << '_';
            }
            *comms << registers[i];
            if (i<numRegisters-1) *comms << '\t';
        };
        *comms << '\n';
    }
};