Ryu Anzawa / Mbed OS 2021_measuringWheel_v3

2022 measuringWheel_v3

Dependencies:   Eigen SerialMultiByte SoftPWM measuring_wheel

main.cpp

Committer:
tanabe2000
Date:
2018-07-31
Revision:
1:d8c40d97ce2c
Parent:
0:23e4f10ffbcb
Child:
2:fd71ffefefe5

File content as of revision 1:d8c40d97ce2c:

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

Serial pc(USBTX, USBRX,115200);
MeasuringWheel measuring(PA_11,PA_12, PA_8,PB_4, PA_6 ,PA_7);

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



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

}