try to fix submodule
This commit is contained in:
@@ -0,0 +1,53 @@
|
||||
|
||||
#pragma once
|
||||
|
||||
#include "../SimpleFOCRegisters.h"
|
||||
#include "../RegisterSender.h"
|
||||
|
||||
#ifndef TELEMETRY_MAX_REGISTERS
|
||||
#define TELEMETRY_MAX_REGISTERS 8
|
||||
#endif
|
||||
|
||||
#ifndef TELEMETRY_MAX_MOTORS
|
||||
#define TELEMETRY_MAX_MOTORS 4
|
||||
#endif
|
||||
|
||||
|
||||
#define DEF_TELEMETRY_DOWNSAMPLE 100
|
||||
|
||||
|
||||
typedef enum : uint8_t {
|
||||
TELEMETRY_FRAMETYPE_DATA = 0x01,
|
||||
TELEMETRY_FRAMETYPE_HEADER = 0x02
|
||||
} TelemetryFrameType;
|
||||
|
||||
|
||||
|
||||
|
||||
class Telemetry : public RegisterSender {
|
||||
public:
|
||||
Telemetry();
|
||||
virtual ~Telemetry();
|
||||
virtual void init();
|
||||
void addMotor(FOCMotor* motor);
|
||||
void setTelemetryRegisters(uint8_t numRegisters, uint8_t* registers, uint8_t* motors = NULL);
|
||||
void run();
|
||||
|
||||
uint16_t downsample = DEF_TELEMETRY_DOWNSAMPLE;
|
||||
uint32_t min_elapsed_time = 0;
|
||||
protected:
|
||||
virtual void sendTelemetry() = 0;
|
||||
virtual void sendHeader() = 0;
|
||||
|
||||
FOCMotor* motors[TELEMETRY_MAX_MOTORS];
|
||||
uint8_t numMotors = 0;
|
||||
|
||||
uint8_t numRegisters;
|
||||
uint8_t registers[TELEMETRY_MAX_REGISTERS];
|
||||
uint8_t registers_motor[TELEMETRY_MAX_REGISTERS];
|
||||
uint8_t frameSize;
|
||||
bool headerSent;
|
||||
long last_run_time = 0;
|
||||
uint16_t downsampleCnt = 0;
|
||||
};
|
||||
|
||||
Reference in New Issue
Block a user