計測輪ボード用プログラム
Dependencies: SerialMultiByte measuring_wheel SoftPWM Eigen
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); } }