read encoder

Dependencies:   mbed

main.cpp

Committer:
JJting
Date:
2018-07-31
Revision:
2:33062fc279ca
Parent:
1:2f2a74337b77

File content as of revision 2:33062fc279ca:

#include "mbed.h"
#include "encoder.h"
 
Serial uart(USBTX, USBRX); 
//Serial uart(D10,D2);            // TX : D10     RX : D2           // blueteeth
DigitalOut LED(A4);            // check if the code is running

// timer
Ticker timer1;
float ITR_time1 = 10000.0;  // unit:us

// uart_tx
union splitter {
    short j;
    char C[2];
    // C[0] is lowbyte of j, C[1] is highbyte of j
};
char T[16] = {255,255,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
int i = 0;

// function
void init_UART();
void init_TIMER();
void timer1_ITR();
void uart_tx();


int main()
{
    LED = 1;
    wait_ms(500);
    // initial sensor
    init_SPI_encoder();
    init_encoder();
    
    // initial uart
    init_UART();
    
    wait_ms(500);
    LED = 0;
    
    init_TIMER();
    
    while(1) {
    }
    
}

void init_UART()
{
    uart.baud(115200);
}

void init_TIMER()
{
    timer1.attach_us(&timer1_ITR, ITR_time1);
}

void timer1_ITR()
{
    angle_measure();
    uart_tx();
}

void uart_tx()
{
    splitter s1;
    splitter s2;
    splitter s3;
    splitter s4;
    splitter s5;
    splitter s6;
    splitter s7;
    
    s1.j = angle;
    s2.j = Angle;
    s3.j = 2;
    s4.j = 3;
    s5.j = 1;
    s6.j = 2;
    s7.j = 3;
    
    T[2] = s1.C[0];
    T[3] = s1.C[1];
    T[4] = s2.C[0];
    T[5] = s2.C[1];
    T[6] = s3.C[0];
    T[7] = s3.C[1];
    T[8] = s4.C[0];
    T[9] = s4.C[1];
    T[10] = s5.C[0];
    T[11] = s5.C[1];
    T[12] = s6.C[0];
    T[13] = s6.C[1];
    T[14] = s7.C[0];
    T[15] = s7.C[1];
    
    while(1) {
        if (uart.writable() == 1) {
            uart.putc(T[i]);
            i++;
        }
        if (i >= (sizeof(T)-1)) {
            i = 0;
            break;
        }
    }
}