20 lines
364 B
C++
20 lines
364 B
C++
#pragma once
|
|
|
|
#include <Arduino.h>
|
|
#include "behaviour_control/complementary_filter.h"
|
|
|
|
#define DRIVE_DURATION_MS 5
|
|
|
|
class Motor {
|
|
|
|
public:
|
|
Motor(int a, int b, int pwm, int angle);
|
|
Motor();
|
|
void drive(int speed);
|
|
void test();
|
|
|
|
public:
|
|
int pinA, pinB, pinPwm, angle, oldSpeed, diff;
|
|
float micros_wait;
|
|
|
|
}; |