Revision 0:a074f8e4001e, committed 2017-10-25

Comitter:

sarlilouis

Date:

Wed Oct 25 15:04:27 2017 +0000

Commit message:

update :)

Changed in this revision

diff -r 000000000000 -r a074f8e4001e rotaryEncoder.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rotaryEncoder.cpp	Wed Oct 25 15:04:27 2017 +0000
@@ -0,0 +1,124 @@
+/********************************************************/
+/*          Library untuk pembacaan Encoder             */
+/*                  Adopsi dari QEI                     */
+/*  Bismillahirahmanirrahim                             */
+/*  Encoder yang sudah dicoba :                         */
+/*  1. Autonics                                         */
+/*  2. Encoder bawaan Motor                             */
+/*                                                      */
+/*  ______________________                              */
+/*  |______Autonics______|                              */
+/*  | Out A = Input 1    |                              */
+/*  | Out B = Input 2    |                              */
+/*  | 5V                 |                              */
+/*  |_Gnd________________|                              */
+/*                                                      */
+/********************************************************/
+//////////////////////////////////////////
+// Library
+/////////////////////////////////////////
+#include "mbed.h"
+#include "rotaryEncoder.h"
+ 
+rotaryEncoder::rotaryEncoder(PinName channelA,
+                         PinName channelB,
+                         int pulsesPerRev,
+                         Encoding encoding) : channelA_(channelA), channelB_(channelB)
+{
+    pulses_       = 0;
+    revolutions_  = 0;
+    pulsesPerRev_ = pulsesPerRev;
+    encoding_     = encoding;
+ 
+    //Workout what the current state is.
+    int chanA = channelA_.read();
+    int chanB = channelB_.read();
+ 
+    //2-bit state.
+    currState_ = (chanA << 1) | (chanB);
+    prevState_ = currState_;
+ 
+    //X2 encoding uses interrupts on only channel A.
+    //X4 encoding uses interrupts on      channel A,
+    //and on channel B.
+    channelA_.rise(this, &rotaryEncoder::encode);
+    channelA_.fall(this, &rotaryEncoder::encode);
+ 
+    //If we're using X4 encoding, then attach interrupts to channel B too.
+    if (encoding == X4_ENCODING) {
+        channelB_.rise(this, &rotaryEncoder::encode);
+        channelB_.fall(this, &rotaryEncoder::encode);
+    }
+}
+ 
+void rotaryEncoder::reset(void) {
+ 
+    pulses_      = 0;
+    revolutions_ = 0;
+ 
+}
+ 
+int rotaryEncoder::getPulses(void) {
+ 
+    return pulses_;
+ 
+}
+ 
+int rotaryEncoder::getRevolutions(void) {
+ 
+    revolutions_ = pulses_ / pulsesPerRev_;
+    return revolutions_;
+ 
+}
+ 
+/***************************************
+ *  Perhitungan Pulse Encoder
+ ***************************************/
+ 
+void rotaryEncoder::encode(void) {
+ 
+    int change = 0;
+    int chanA  = channelA_.read();
+    int chanB  = channelB_.read();
+ 
+    //2-bit state.
+    currState_ = (chanA << 1) | (chanB);
+ 
+    if (encoding_ == X2_ENCODING) {
+ 
+        //11->00->11->00 is counter clockwise rotation or "forward".
+        if ((prevState_ == 0x3 && currState_ == 0x0) ||
+                (prevState_ == 0x0 && currState_ == 0x3)) {
+ 
+            pulses_++;
+ 
+        }
+        //10->01->10->01 is clockwise rotation or "backward".
+        else if ((prevState_ == 0x2 && currState_ == 0x1) ||
+                 (prevState_ == 0x1 && currState_ == 0x2)) {
+ 
+            pulses_--;
+ 
+        }
+ 
+    } else if (encoding_ == X4_ENCODING) {
+ 
+        //Entered a new valid state.
+        if (((currState_ ^ prevState_) != INVALID) && (currState_ != prevState_)) {
+            //2 bit state. Right hand bit of prev XOR left hand bit of current
+            //gives 0 if clockwise rotation and 1 if counter clockwise rotation.
+            change = (prevState_ & PREV_MASK) ^ ((currState_ & CURR_MASK) >> 1);
+ 
+            if (change == 0) {
+                change = -1;
+            }
+ 
+            pulses_ -= change;
+        }
+ 
+    }
+ 
+    prevState_ = currState_;
+ 
+}
+ 
\ No newline at end of file

diff -r 000000000000 -r a074f8e4001e rotaryEncoder.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rotaryEncoder.h	Wed Oct 25 15:04:27 2017 +0000
@@ -0,0 +1,82 @@
+#ifndef ROTARYENCODER_H
+#define ROTARYENCODER_H
+//////////////////////////////////////////
+// Library
+/////////////////////////////////////////
+#include "mbed.h"
+
+ 
+////////////////////////////////////////////////////////////////////////////////
+// Define Konstanta
+////////////////////////////////////////////////////////////////////////////////
+#define PREV_MASK 0x1 //Konstanta untuk mengetahui previous direction
+#define CURR_MASK 0x2 //Konstanta untuk mengetahui current direction
+#define INVALID   0x3 //XORing two states where both bits have changed.
+ 
+ 
+/********************************
+ * Quadrature Encoder Interface *
+ ********************************/
+ 
+class rotaryEncoder {
+ 
+public:
+ 
+    typedef enum Encoding {
+ 
+        X2_ENCODING,
+        X4_ENCODING
+ 
+    } Encoding;
+    
+    rotaryEncoder(PinName channelA, PinName channelB, int pulsesPerRev, Encoding encoding = X2_ENCODING);
+    /******************************************* 
+     * Membuat interface dari encoder    
+     * @param inA DigitalIn, out A dari encoder
+     * @param inB DigitalIn, out B dari encoder
+     *******************************************/
+     
+    void reset(void);
+    /*******************************************
+     * Reset encoder.
+     * Reset pembacaaan menjadi 0
+     *******************************************/
+     
+    int getPulses(void);
+    /*******************************************
+     * Membaca pulse yang didapat oleh encoder
+     * @return Nilai pulse yang telah dilalui.
+     *******************************************/
+    
+    int getRevolutions(void);
+    /*******************************************
+     * Membaca putaran yang didapat oleh encoder
+     * @return Nilai revolusi/putaran yang telah dilalui.
+     *******************************************/
+ 
+private:
+ 
+    void encode(void);
+    /*******************************************
+     * Menghitung pulse
+     * Digunakan setiap rising/falling edge baik channel A atau B
+     * Membaca putaran CW atau CCW => mengakibatkan pertambahan/pengurangan pulse
+     *******************************************/
+    
+//VARIABEL UNTUK PERHITUNGAN PULSE
+    Encoding encoding_;
+ 
+    InterruptIn channelA_;
+    InterruptIn channelB_;
+ 
+    int          pulsesPerRev_;
+    int          prevState_;
+    int          currState_;
+ 
+    volatile int pulses_;
+    volatile int revolutions_;
+ 
+ 
+};
+ 
+#endif /* ROTARYENCODER_H */
\ No newline at end of file