計測輪ボード用プログラム

Dependencies:   SerialMultiByte measuring_wheel SoftPWM Eigen

Committer:
tanabe2000
Date:
Mon Aug 27 04:49:22 2018 +0000
Revision:
2:fd71ffefefe5
Parent:
1:d8c40d97ce2c
Child:
5:9332620c08c6
ver3

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tanabe2000 0:23e4f10ffbcb 1 #include "mbed.h"
tanabe2000 0:23e4f10ffbcb 2 #include "measuring_wheel.h"
tanabe2000 0:23e4f10ffbcb 3
tanabe2000 0:23e4f10ffbcb 4 Serial pc(USBTX, USBRX,115200);
tanabe2000 2:fd71ffefefe5 5 MeasuringWheel measuring(PA_8,PA_9,PA_6,PA_7,PA_0,PA_1);
tanabe2000 1:d8c40d97ce2c 6
tanabe2000 1:d8c40d97ce2c 7 int main()
tanabe2000 1:d8c40d97ce2c 8 {
tanabe2000 1:d8c40d97ce2c 9 measuring.wheelDiameter(48,48,48);
tanabe2000 1:d8c40d97ce2c 10 while(true) {
tanabe2000 1:d8c40d97ce2c 11
tanabe2000 1:d8c40d97ce2c 12
tanabe2000 1:d8c40d97ce2c 13
tanabe2000 1:d8c40d97ce2c 14 // pc.printf("fsjflsz\r\n");
tanabe2000 2:fd71ffefefe5 15 // pc.printf("%d,%d,\n",(int)measuring.getOutX(),(int)measuring.getOutY());
tanabe2000 2:fd71ffefefe5 16 // pc.printf("w1 = %f, w2 = %f, w3 = %f\r\n",measuring.getWheel1(),measuring.getWheel2(),measuring.getWheel3());
tanabe2000 1:d8c40d97ce2c 17 pc.printf("yaw = %f\r\n",measuring.getjyroAngle());
tanabe2000 1:d8c40d97ce2c 18 // wait(0.1);
tanabe2000 0:23e4f10ffbcb 19 }
tanabe2000 1:d8c40d97ce2c 20
tanabe2000 0:23e4f10ffbcb 21 }