Chen Wei Ting
/
LSM9DS1_project_3
read encoder
main.cpp
- Committer:
- JJting
- Date:
- 2018-07-31
- Revision:
- 1:2f2a74337b77
- Parent:
- 0:f2657b94ea70
- Child:
- 2:33062fc279ca
File content as of revision 1:2f2a74337b77:
#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:ms // encoder //DigitalOut encoder_cs(D9); //SPI spi_encoder(D11, D12, D13); // mosi, miso, sclk //unsigned short encoder_value = 0; //unsigned short angle = 0; //unsigned short angle_old; //unsigned short angle_init; //int angle_dif; //int a_dif; //int Angle; //unsigned short k = 0; // 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_encoder(); //void init_SPI_encoder(); void init_UART(); void init_TIMER(); void timer1_ITR(); //void angle_measure(); //int angle_count(unsigned short,unsigned short); void uart_tx(); int main() { LED = 1; wait_ms(500); // initial sensor init_encoder(); init_SPI_encoder(); // initial uart init_UART(); wait_ms(500); LED = 0; init_TIMER(); while(1) { } } /* void init_encoder() { // encoder_cs = 1; // disable encoder encoder_cs = 0; // Select the device by seting chip select low encoder_value = spi_encoder.write(0x00); angle_init = encoder_value >> 3; encoder_cs = 1; // Deselect the device } */ /* void init_SPI_encoder() { spi_encoder.format(16,3); spi_encoder.frequency(1000000); // 1MHz clock rate } */ void init_UART() { uart.baud(115200); } void init_TIMER() { timer1.attach_us(&timer1_ITR, ITR_time1); } void timer1_ITR() { angle_measure(); // angle_count(); uart_tx(); } /* void angle_measure() { encoder_cs = 0; // Select the device by seting chip select low encoder_value = spi_encoder.write(0x00); angle = encoder_value >> 3; encoder_cs = 1; // Deselect the device if (k == 0) { angle_dif = angle_count(angle, angle_init); Angle = angle_init + angle_dif; angle_old = angle; k++; } else { angle_dif = angle_count(angle, angle_old); Angle = Angle + angle_dif; angle_old = angle; } } */ /* int angle_count(unsigned short now,unsigned short old) { a_dif = now - old; if (a_dif > 4096/2) a_dif = -(4096 - a_dif); else if (a_dif < -4096/2) a_dif = 4096 + a_dif; else a_dif = a_dif; return a_dif; } */ 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; } } }