2 motoren, pins correct

Dependencies:   MODSERIAL mbed QEI

Fork of PWM_motor by Felix Dransfeld

main.cpp

Committer:
cmaas
Date:
2018-09-28
Revision:
1:2ec710725db2
Parent:
0:0cb350eb704a
Child:
2:47b7491935dc

File content as of revision 1:2ec710725db2:

#include "mbed.h"
#include "MODSERIAL.h"

//AnalogIn pot1(A1);
//AnalogIn pot2(A2);
DigitalIn encoder(D8);
PwmOut pwmpin1(D5);
PwmOut pwmpin2(D6);
DigitalOut directionpin(D4);
DigitalOut directionpin2(D7);
MODSERIAL pc(USBTX, USBRX);

int main()
{
        pc.baud(9600);
    
    pwmpin1.period_us(60); //60 microsecondsPWM period, 16.7 kHz
    pwmpin2.period_us(60);
   //float ain1;
   //float ain2;
    
    while(true){
       // ain1 = pot1.read();
        // ain2 = pot2.read();
        
        float u = -0.9f; //determineusefulvalue, -0.3f is justanexample
        directionpin= u > 0.0f; //eithertrueor false
        pwmpin1= fabs(u); //pwmduty cycle canonlybepositive, floatingpoint absolute value
        pwmpin2= fabs(u);
        
        wait(0.5f);
        
        printf("Motorsnelheid %i \n \r", encoder); 
        
    }
}