Diff: measuring_wheel.cpp

Revision:

1:3f01bf4d7e56

Parent:

0:505dd5510add

Child:

2:f34a22b28ac5

diff -r 505dd5510add -r 3f01bf4d7e56 measuring_wheel.cpp
--- a/measuring_wheel.cpp	Mon Jul 02 08:38:07 2018 +0000
+++ b/measuring_wheel.cpp	Wed Jul 04 09:32:06 2018 +0000
@@ -3,13 +3,17 @@
 MeasuringWheel::MeasuringWheel(PinName channel1_1, PinName channel1_2, PinName channel2_1, PinName channel2_2, PinName channel3_1, PinName channel3_2):
     w1(channel1_1, channel1_2, NC, 500, QEI::X4_ENCODING),
     w2(channel2_1, channel2_2, NC, 500, QEI::X4_ENCODING),
-    w3(channel3_1, channel3_2, NC, 500, QEI::X4_ENCODING)
+    w3(channel3_1, channel3_2, NC, 500, QEI::X4_ENCODING),
+    mainMicon(PC_10, PC_11, 115200),
+    led(LED2)
 
 {
     radian[0] = 0;
     radian[1] = -2*PI/3;
     radian[2] = 2*PI/3;
-    ticker.attach(callback(this, &MeasuringWheel::computeXY),0.001);
+    ticker.attach(callback(this, &MeasuringWheel::computeXY),0.01);
+    ticker1.attach(callback(this, &MeasuringWheel::transmissionXY),0.1);
+//    mainMicon.attach(callback(this, &MeasuringWheel::resetpisithon));//受信割り込み
 }
 
 
@@ -50,29 +54,10 @@
     return Y;
 }
 
-TransmissionXY::TransmissionXY(PinName serialTX,PinName serialRX): mainMicon(serialTX, serialRX, 115200), led(LED2)
-{
-//    mainMicon.attach(callback(this, &TransmissionXY::resetpisithon));
-}
-
-void TransmissionXY::resetpisithon()
+void MeasuringWheel::transmissionXY()
 {
-    get = mainMicon.getc();
-    if(get == 'R') {
-        ofsetX = X_;
-        ofsetY = Y_;
-        led = !led;
-    }
-    X_ -= ofsetX;
-    Y_ -= ofsetY;
-
-}
-
-bool TransmissionXY::sendMeasuring(MeasuringWheel &request)
-{
-
-    X_ = request.getOutX()+32768;
-    Y_ = request.getOutY()+32768;
+    X_ = X + 32768;
+    Y_ = Y + 32768;
     upBitX = (X_ >> 8) & 0xff;
     downBitX = X_ & 0xff;
     upBitY = (Y_ >> 8) & 0xff;
@@ -83,6 +68,17 @@
     mainMicon.putc(downBitX);
     mainMicon.putc(upBitY);
     mainMicon.putc(downBitY);
+}
 
-    return 1;
-}
\ No newline at end of file
+//void MeasuringWheel::resetpisithon()
+//{
+//    get = mainMicon.getc();
+//    if(get != 'R') {
+//        //X = 0;
+////        Y = 0;
+////        led = !led;
+//    }
+//
+//
+//}
+