GDP 4
/
KL25Z_Camera_Test
Sends raw hex values from camera to hosted program
main.cpp
- Committer:
- FatCookies
- Date:
- 2016-11-11
- Revision:
- 4:968036e0940b
- Parent:
- 3:564463c06ffa
- Child:
- 5:727d5bbc14a5
File content as of revision 4:968036e0940b:
#include "mbed.h" #include "TFC.h" #define CAM_THRESHOLD 128 DigitalOut myled(LED1); Serial pc(PTD3,PTD2); char curr_line[128]; uint8_t curr_left; uint8_t curr_right; uint8_t right; uint8_t left; uint8_t measured_value; int main() { TFC_Init(); pc.baud(57600); uint32_t i = 0; while(1) { //If we have an image ready if(TFC_LineScanImageReady>0) { left = 0; right = 0; for(i = 63; i > 0; i--) { curr_left = (int8_t)(TFC_LineScanImage0[i] >> 4) & 0xFF; if(curr_left < CAM_THRESHOLD) { left = i; break; } } for(i = 64; i < 128; i++) { curr_right = (int8_t)(TFC_LineScanImage0[i] >> 4) & 0xFF; if(curr_right < CAM_THRESHOLD) { right = i; break; } } pc.putc('H'); for(i = 0; i < 128; i++) { pc.putc((int8_t)(TFC_LineScanImage0[i] >> 4) & 0xFF); } measured_value = (64 - ((left+right)/2))/64.f; //Reset image ready flag TFC_LineScanImageReady=0; wait(0.05); } } }