File content as of revision 20:8063c82bbb35:

#include "QEI.h"
#include "Motor.h"
#include "pot.h"
#include <time.h>

 
Serial pc(USBTX, USBRX);
//Use X4 encoding.
//QEI wheel(p29, p30, NC, 624, QEI::X4_ENCODING);
//Use X2 encoding by default.
QEI encoder (PTC16, PTC17, PTB9, 512);
Motor motor(PTC4, PTD0, PTC3, PTC12, PTB23, 2000);
Pot pend(PTC10, &encoder,0);
Ticker update;

void test_distance(){
    int wait = 1000;
    int steps = 100;
    while (wait > 500){
        while (steps > 10){
            printf("steps: %i wait: %i \r\n", steps, wait);
            for( int i = 0; i < 3; i++){
                encoder.reset();
                motor.step_clockwise(steps, wait);
                int pulses_cw = encoder.getPulses();
                wait_ms(200);
                int coast_pulses_cw = encoder.getPulses();
                
                encoder.reset();
                motor.step_anticlockwise(steps, wait);
                int pulses_ccw = encoder.getPulses();
                wait_ms(200);
                int coast_pulses_ccw = encoder.getPulses();
                printf("trial: %i \tclockwise pluses: \t%i  \tanticlockwise pluses: \t%i \r\n", i + 1, pulses_cw, pulses_ccw);
                printf("\t\tpulses after coast: \t%i \tpulses after coast: \t%i\r\n", coast_pulses_cw, coast_pulses_ccw);
            }
            steps -=10;
            printf("\r\n");
        }
        
        wait-=100;
        steps=100;
    }       
}

void test_speed() {
    time_t start;
    double elapsed_time = 0;
    int steps = 10;
    int wait = 1000;
    printf("steps: %i\r\n", steps);
            for( int i = 0; i < 3; i++){
                encoder.reset();
                start = time(0);
                motor.step_clockwise(steps, wait);
                elapsed_time = difftime( time(0), start);
                printf("Round %i clockwise, Total duration: \t%f seconds\r\n", i, elapsed_time);
                wait_ms(200);
                
                encoder.reset();
                start = time(0);
                motor.step_anticlockwise(steps, wait);
                elapsed_time = difftime( time(0), start);
                printf("Round %i counter-clockwise, Total duration: \t%f seconds\r\n", i, elapsed_time);
                wait_ms(200);
            }
}


void test_pendulum(){
    while(1){
        printf("angle: %f \r\n", pend.get_angle());   
    }
}
void calibrate_pendulum(){
    encoder.reset();
    while(1){
        printf("voltage %%: %f  pulse: %i", pend.angle_as_voltage(), encoder.getPulses());
    }
}
void move_pulses(int pulses, int wait){ // find number of pulses from the encoder going from one end to the other.
    int start = encoder.getPulses();
    if(pulses >= 0){
        while(encoder.getPulses() < start + pulses){
            printf("here");
          // motor.clockwise(wait);    
        } 
    }else{
        while(encoder.getPulses() > start + pulses){
          // motor.anticlockwise(wait);
        }
    } 
}

void test_pulsetodist(){ // have user input x amount of pulses to move motor a certain distance

    while(1)
    {
        char str[4];
        int steps = 0;
        int wait = 1000;
        time_t start = time(0);
        double elapsed;      
        printf("Enter the amount of steps: ");
        fgets(str,4,stdin);
        printf("\r\nSteps: %s", str);
        steps = atoi(str);
        
        if(steps > 0)
            motor.step_clockwise(steps, wait);
        else
            motor.step_anticlockwise(steps, wait);
        elapsed = difftime( time(0), start);
        printf("\r\nTook %i steps in time: %f \r\n",steps, elapsed);
    }
}
void update_handler(){
    pend.update();
}
int main() {
  update.attach(&update_handler, pend.UPDATE_TIME);
  wait(1);
  pend.set_zeros(); 
    while(1)pend.print_test();
    
}