Ryu Anzawa / Mbed OS 2021_measuringWheel_v3

2022 measuringWheel_v3

Dependencies:   Eigen SerialMultiByte SoftPWM measuring_wheel

main.cpp

Committer:
tanabe2000
Date:
2018-08-27
Revision:
2:fd71ffefefe5
Parent:
1:d8c40d97ce2c
Child:
5:9332620c08c6

File content as of revision 2:fd71ffefefe5:

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

Serial pc(USBTX, USBRX,115200);
MeasuringWheel measuring(PA_8,PA_9,PA_6,PA_7,PA_0,PA_1);

int main()
{
    measuring.wheelDiameter(48,48,48);
    while(true) {



//        pc.printf("fsjflsz\r\n");
//        pc.printf("%d,%d,\n",(int)measuring.getOutX(),(int)measuring.getOutY());
//        pc.printf("w1 = %f, w2 = %f, w3 = %f\r\n",measuring.getWheel1(),measuring.getWheel2(),measuring.getWheel3());
            pc.printf("yaw = %f\r\n",measuring.getjyroAngle());
//        wait(0.1);
    }

}