2022 measuringWheel_v3

Dependencies:   Eigen SerialMultiByte SoftPWM measuring_wheel

main.cpp

Committer:
piroro4560
Date:
20 months ago
Revision:
7:120f12ff6ef1
Parent:
6:f4a6cc918833

File content as of revision 7:120f12ff6ef1:

#include "mbed.h"
#include "measuring_wheel.h"
#include "pin_config.h"

Serial pc(USBTX,USBRX, 115200);
//3,1,5
//MeasuringWheel measuring(PA_1,PA_0, PA_8, PA_9, PB_6,PB_7);
//1,3,4
//MeasuringWheel measuring(PB_6, PB_7, PA_8, PA_9, PC_6, PC_7);
//MeasuringWheel measuring(encoder1_a, encoder1_b, encoder2_a, encoder2_b, encoder3_a, encoder3_b);
MeasuringWheel measuring(PA_1,PA_0, PA_9,PA_8, PB_7,PB_6);

int main() {
    while (true) {
        pc.printf("x = %f,  y = %f, theta = %f\r\n", measuring.getOutX(), measuring.getOutY(), measuring.getjyroAngle());
    }
}