ES305H Lanier Turchan / Mbed 2 deprecated GainController

Dependencies:   QEI mbed

GainControl.cpp

Committer:
LanierUSNA16
Date:
2015-03-24
Revision:
0:8d7b6e55609a
Child:
1:d4c2e72540db

File content as of revision 0:8d7b6e55609a:

#include "mbed.h"
#include "QEI.h"

PwmOut turret_speed(p21);
DigitalOut turret_direction(p22);

QEI myEncoder (p16,p15, NC, 1600); 
Timer t;

int main()
{
int input_dc =50; 
int user_direction = 0;
float duty_cycle = 0.6; 
int pulses = 0; 
float theta = 0.0;  
float time =0.0;

while(1)
    {
    printf("Enter duty cycle, 0 to 100:\n"); 
    scanf("%d", &input_dc); 
    duty_cycle = input_dc/100.0;  
    
    printf("%f duty cycle set. Enter 0 for CCW or 1 for CW spin direction:\n",duty_cycle); 
    scanf("%d", &user_direction); 
    
    printf("it's starting... move the thing!\n");
    t.start();
    turret_speed = duty_cycle; 
    turret_direction = user_direction; 
    
    pulses = myEncoder.getPulses(); 
    theta = ((float)pulses/ (1600.0*2.0))*-2.0*3.14;
    time = t.read(); 
    
    printf("time = %.5f;\n",time);
    printf("theta = %.5f;\n",theta); 
    printf("%f duty cycle. %d spin.\n", duty_cycle, user_direction); 
            
    }
}