File content as of revision 21:eac29cf3f061:

#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){
            motor.clockwise(wait);    
        } 
    }else{
        while(encoder.getPulses() > start + pulses){
            motor.anticlockwise(wait);
        }
    } 
}

void update_handler(){
    pend.update();
}
int main(){
    int neg = -1;
    encoder.reset();
    update.attach(&update_handler, pend.UPDATE_TIME);
    pend.set_zeros();
    int waits = 700;
    while(1){
        move_pulses(1000*neg, waits);
        neg*= -1;
        if(neg == -1)
            waits -= 10;
        printf("Wait time: %i\r\n", waits);
        pend.print_test();
        wait(3);
    }
}
/*  update.attach(&update_handler, pend.UPDATE_TIME);
  wait(1);
  pend.set_zeros(); 
    while(1)pend.print_test();
    
}
*/