計測輪ボード用プログラム
Dependencies: SerialMultiByte measuring_wheel SoftPWM Eigen
main.cpp@1:d8c40d97ce2c, 2018-07-31 (annotated)
- Committer:
- tanabe2000
- Date:
- Tue Jul 31 08:33:23 2018 +0000
- Revision:
- 1:d8c40d97ce2c
- Parent:
- 0:23e4f10ffbcb
- Child:
- 2:fd71ffefefe5
ver2.1;
Who changed what in which revision?
User | Revision | Line number | New 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 | 1:d8c40d97ce2c | 5 | MeasuringWheel measuring(PA_11,PA_12, PA_8,PB_4, PA_6 ,PA_7); |
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 | 1:d8c40d97ce2c | 15 | // pc.printf("X = %f, Y = %f\r\n",measuring.getOutX(),measuring.getOutY()); |
tanabe2000 | 1:d8c40d97ce2c | 16 | pc.printf("wi = %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 | } |