Replaced protocol with git submodule
This commit is contained in:
2
.gitmodules
vendored
2
.gitmodules
vendored
@@ -1,3 +1,3 @@
|
|||||||
[submodule "bobbycar-protocol"]
|
[submodule "src/bobbycar-protocol"]
|
||||||
path = src/bobbycar-protocol
|
path = src/bobbycar-protocol
|
||||||
url = git@github.com:bobbycar-graz/bobbycar-protocol.git
|
url = git@github.com:bobbycar-graz/bobbycar-protocol.git
|
||||||
|
1
src/bobbycar-protocol
Submodule
1
src/bobbycar-protocol
Submodule
Submodule src/bobbycar-protocol added at 39f76cb62b
@@ -1,122 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
namespace {
|
|
||||||
|
|
||||||
enum class ControlType : uint8_t {
|
|
||||||
Commutation,
|
|
||||||
Sinusoidal,
|
|
||||||
FieldOrientedControl
|
|
||||||
};
|
|
||||||
|
|
||||||
enum class ControlMode : uint8_t {
|
|
||||||
OpenMode,
|
|
||||||
Voltage,
|
|
||||||
Speed, // Only with FieldOrientedControl
|
|
||||||
Torque // Only with FieldOrientedControl
|
|
||||||
};
|
|
||||||
|
|
||||||
struct MotorState {
|
|
||||||
bool enable = false;
|
|
||||||
int16_t pwm = 0;
|
|
||||||
ControlType ctrlTyp = ControlType::FieldOrientedControl;
|
|
||||||
ControlMode ctrlMod = ControlMode::OpenMode;
|
|
||||||
int16_t iMotMax = 15; // [A] Maximum motor current limit
|
|
||||||
int16_t iDcMax = 17; // [A] Maximum DC Link current limit (This is the final current protection. Above this value, current chopping is applied. To avoid this make sure that I_DC_MAX = I_MOT_MAX + 2A)
|
|
||||||
int16_t nMotMax = 1000; // [rpm] Maximum motor speed limit
|
|
||||||
int16_t fieldWeakMax = 10; // [A] Maximum Field Weakening D axis current (only for FOC). Higher current results in higher maximum speed.
|
|
||||||
int16_t phaseAdvMax = 40; // [deg] Maximum Phase Advance angle (only for SIN). Higher angle results in higher maximum speed.
|
|
||||||
};
|
|
||||||
|
|
||||||
uint16_t calculateChecksum(MotorState state) {
|
|
||||||
return
|
|
||||||
uint16_t(state.enable) ^
|
|
||||||
state.pwm ^
|
|
||||||
uint16_t(state.ctrlTyp) ^
|
|
||||||
uint16_t(state.ctrlMod) ^
|
|
||||||
state.iMotMax ^
|
|
||||||
state.iDcMax ^
|
|
||||||
state.nMotMax ^
|
|
||||||
state.fieldWeakMax ^
|
|
||||||
state.phaseAdvMax;
|
|
||||||
}
|
|
||||||
|
|
||||||
struct BuzzerState {
|
|
||||||
uint8_t freq = 0;
|
|
||||||
uint8_t pattern = 0;
|
|
||||||
};
|
|
||||||
|
|
||||||
uint16_t calculateChecksum(BuzzerState state) {
|
|
||||||
return state.freq ^ state.pattern;
|
|
||||||
}
|
|
||||||
|
|
||||||
struct Command {
|
|
||||||
static constexpr uint16_t VALID_HEADER = 0xAAAA;
|
|
||||||
static constexpr uint16_t INVALID_HEADER = 0xFFFF;
|
|
||||||
|
|
||||||
uint16_t start;
|
|
||||||
|
|
||||||
MotorState left, right;
|
|
||||||
|
|
||||||
BuzzerState buzzer;
|
|
||||||
|
|
||||||
bool poweroff = false;
|
|
||||||
bool led = false;
|
|
||||||
|
|
||||||
uint16_t checksum;
|
|
||||||
};
|
|
||||||
|
|
||||||
uint16_t calculateChecksum(Command command) {
|
|
||||||
return command.start ^
|
|
||||||
calculateChecksum(command.left) ^
|
|
||||||
calculateChecksum(command.right) ^
|
|
||||||
calculateChecksum(command.buzzer) ^
|
|
||||||
command.poweroff ^
|
|
||||||
command.led;
|
|
||||||
}
|
|
||||||
|
|
||||||
struct MotorFeedback {
|
|
||||||
int16_t angle = 0;
|
|
||||||
int16_t speed = 0;
|
|
||||||
uint8_t error = 0;
|
|
||||||
int16_t current = 0;
|
|
||||||
uint32_t chops = 0;
|
|
||||||
bool hallA = false,
|
|
||||||
hallB = false,
|
|
||||||
hallC = false;
|
|
||||||
};
|
|
||||||
|
|
||||||
uint16_t calculateChecksum(MotorFeedback feedback) {
|
|
||||||
return feedback.angle ^ feedback.speed ^
|
|
||||||
feedback.error ^ feedback.current ^
|
|
||||||
feedback.chops ^
|
|
||||||
feedback.hallA ^ feedback.hallB ^ feedback.hallC;
|
|
||||||
}
|
|
||||||
|
|
||||||
struct Feedback {
|
|
||||||
static constexpr uint16_t VALID_HEADER = 0xAAAA;
|
|
||||||
static constexpr uint16_t INVALID_HEADER = 0xFFFF;
|
|
||||||
|
|
||||||
uint16_t start;
|
|
||||||
|
|
||||||
MotorFeedback left, right;
|
|
||||||
|
|
||||||
int16_t batVoltage = 0;
|
|
||||||
int16_t boardTemp = 0;
|
|
||||||
|
|
||||||
int16_t timeoutCntSerial = 0;
|
|
||||||
|
|
||||||
uint16_t checksum;
|
|
||||||
};
|
|
||||||
|
|
||||||
uint16_t calculateChecksum(Feedback feedback) {
|
|
||||||
return feedback.start ^
|
|
||||||
calculateChecksum(feedback.left) ^
|
|
||||||
calculateChecksum(feedback.right) ^
|
|
||||||
feedback.batVoltage ^
|
|
||||||
feedback.boardTemp ^
|
|
||||||
feedback.timeoutCntSerial;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
Reference in New Issue
Block a user