Using HIDScope for P(I)D controller

Dependencies:   FastPWM HIDScope MODSERIAL QEI biquadFilter mbed

Fork of PES_tutorial_5 by BMT Module 9 Group 4

main.cpp

Committer:
1856413
Date:
2018-10-15
Revision:
7:3b503177ff5c
Parent:
6:bd73804c8cec
Child:
8:ceb9abb5a4a8

File content as of revision 7:3b503177ff5c:

#include "mbed.h"
#include "FastPWM.h"    // FastPWM library
#include "MODSERIAL.h"
#include "QEI.h"
MODSERIAL pc(USBTX, USBRX);
DigitalOut motor1_direction(D7);
AnalogIn pot1(A4);
InterruptIn but2(D3);
FastPWM motor1_pwm(D6); //FastPWM input, PES lecture 2
Ticker MotorInterrupt;
QEI Encoder (D12, D13, NC, 64, QEI::X4_ENCODING);

void Motor()
{
    // Aflezen Potentiometers voor PWM
    motor1_pwm = pot1.read(); // Aflezen PotMeter 1 (volatile omdat je altijd de potmeter wil blijven lezen)
    pc.printf("%i\r\n", Encoder.getPulses());
}
   
void buttonpress()
{
    motor1_direction = 1 - motor1_direction;
    float motor1_velocity = pot1.read() *2.0;
   
    pc.printf("Velocity is %f \r\n", motor1_velocity);
}

int main()
{
    pc.baud(115200);
    motor1_pwm.period_us(60.0); // 60 microseconds PWM period, 16.7 kHz, defines all PWM pins (only needs to done once), FastPWM variabele
    MotorInterrupt.attach(Motor, 0.5); // Ticker die de functie Motor aanroept elke halve seconde, meer tijd is tragere respons op potmeter
    but2.rise(buttonpress);
    while(true){} // Endless loop  
}