mencari respon motor launcher dengan fungsi step

Dependencies:   Motor mbed millis

Fork of transfer_function_motor_baru by KRAI 2017

main.cpp

Committer:
Najib_irvani
Date:
2017-04-13
Revision:
2:8f1bb7191680
Parent:
1:3a234ff1442b
Child:
3:6123379ef617

File content as of revision 2:8f1bb7191680:

#include "mbed.h"
#include "encoderKRAI.h"
#include "Motor.h"
#include "millis.h"
 
//encoderKRAI encoder( PC_12, PD_2, 28, encoderKRAI::X4_ENCODING);
encoderKRAI encoder( PC_10, PC_11, 28, encoderKRAI::X4_ENCODING);
Serial pc(USBTX,USBRX);
//Motor motor(PB_3, PC_4, PA_10);
Motor motor(PA_5,PB_12,PA_11);

unsigned long int previousMillis = 0;
unsigned long int currentMillis;
int rpm;



int main() {

startMillis();  
pc.baud(115200);  
motor.speed(0.5);
startMillis();
    
    while(1) {

        currentMillis = millis();
        
        
        if (currentMillis-previousMillis>=12.5)
        {
            rpm = encoder.getPulses();
            pc.printf("%d\n",rpm);
            encoder.reset();
            previousMillis = currentMillis;
        }

    }
}