Encoder read code

Dependencies:   mbed encoderKRTMI Motornew millis

main.cpp

Committer:
SalbiFaza
Date:
2019-02-23
Revision:
0:8c90db18512f

File content as of revision 0:8c90db18512f:

//library
#include "mbed.h"
#include "encoderKRTMI.h"
#include "millis.h"
#include "Motor.h"

//Konstanta

//Roda KRTMI = 0.61313625 
#define PULSE_TO_JARAK 0.61313625 //jarak yang ditempuh oleh roda (keliling roda)

// PX1 diganti Pin yang dipakai, PY1 diganti Pin yang dipakai, 538 banyaknya pulse (spesifikasi dari encoder), X4_ENCODING dari library,
// PX2 diganti Pin yang dipakai, PY2 diganti Pin yang dipakai, 538 banyaknya pulse (spesifikasi dari encoder), X4_ENCODING dari library,
encoderKRTMI encoderMotorX (PB_1, PC_2, 538, encoderKRTMI::X4_ENCODING);  
encoderKRTMI encoderMotorY (PB_3, PC_4, 538, encoderKRTMI::X4_ENCODING); 

Serial pc(USBTX, USBRX);

//variabel global
float timeSampling;
double pulseX; // pulseX diganti dengan pulse nama motor
double pulseY; // pulseY diganti dengan pulse nama motor

//
int main (){
    pc.baud(115200);
    while(1){
        pulseX = (double) encoderMotorX.getPulses()*PULSE_TO_JARAK;
        pulseY = (double) encoderMotorY.getPulses()*PULSE_TO_JARAK;
        pc.printf("X: $if\t Y: $if\n",pulseX,pulseY);
        wait(0.2);
    }
}