Ashley Mills / Y201

Library for LinkSprite Y201 JPEG serial camera.

Y201.cpp@2:7d8a6087f2e5, 2012-06-29 (annotated)

Committer:
ashleymills
Date:
Fri Jun 29 19:10:17 2012 +0000
Revision:
2:7d8a6087f2e5
Parent:
1:30a6aeda21c2
Child:
4:6e575c19681f
Fixed a timing bug and changed to use MODSERIAL for buffered serial.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ashleymills 0:4c0fca059a0a 1 #include "Y201.h"
ashleymills 0:4c0fca059a0a 2 #include "rtos.h"
ashleymills 0:4c0fca059a0a 3
ashleymills 0:4c0fca059a0a 4 void Y201::trash() {
ashleymills 0:4c0fca059a0a 5 // wait for trash...
ashleymills 0:4c0fca059a0a 6 while(readable()) {
ashleymills 0:4c0fca059a0a 7 int x = getc();
ashleymills 0:4c0fca059a0a 8 }
ashleymills 0:4c0fca059a0a 9 }
ashleymills 0:4c0fca059a0a 10
ashleymills 0:4c0fca059a0a 11 bool Y201::readImage(int startAddress, int readLen, uint8_t *readBuffer) {
ashleymills 0:4c0fca059a0a 12 putSeq(readFileHead,readFileHeadLen);
ashleymills 0:4c0fca059a0a 13 putc(startAddress>>8); // Start Address MSB
ashleymills 0:4c0fca059a0a 14 putc(startAddress&255); // Start Address LSB
ashleymills 0:4c0fca059a0a 15 putc(0x00);
ashleymills 0:4c0fca059a0a 16 putc(0x00);
ashleymills 0:4c0fca059a0a 17 putc(readLen>>8); // Length of file MSB
ashleymills 0:4c0fca059a0a 18 putc(readLen&255); // length of file LSB
ashleymills 0:4c0fca059a0a 19 putc(0x00); // Interval MSB
ashleymills 0:4c0fca059a0a 20 putc(0x0A); // Interval LSB
ashleymills 0:4c0fca059a0a 21 int nread = 0;
ashleymills 0:4c0fca059a0a 22 if(waitFor(readFileAck,readFileAckLen)) {
ashleymills 0:4c0fca059a0a 23 Thread::wait(1);
ashleymills 0:4c0fca059a0a 24 while(nread<readLen) {
ashleymills 0:4c0fca059a0a 25 if(readable()) {
ashleymills 0:4c0fca059a0a 26 uint8_t c = getc();
ashleymills 0:4c0fca059a0a 27 readBuffer[nread] = c;
ashleymills 0:4c0fca059a0a 28 //printf("Read(%d): 0x%x\r\n",nread,readBuffer[nread]);
ashleymills 0:4c0fca059a0a 29 nread++;
ashleymills 0:4c0fca059a0a 30 }
ashleymills 0:4c0fca059a0a 31 }
ashleymills 2:7d8a6087f2e5 32 Thread::wait(1);
ashleymills 0:4c0fca059a0a 33 } else {
ashleymills 0:4c0fca059a0a 34 printf("Error during file read\r\n");
ashleymills 0:4c0fca059a0a 35 return false;
ashleymills 0:4c0fca059a0a 36 }
ashleymills 0:4c0fca059a0a 37 return true;
ashleymills 0:4c0fca059a0a 38 }
ashleymills 0:4c0fca059a0a 39
ashleymills 0:4c0fca059a0a 40 bool Y201::waitFor(const int *seq, const int seqLen) {
ashleymills 0:4c0fca059a0a 41 int spos = 0;
ashleymills 0:4c0fca059a0a 42 long timeout = 100000000;
ashleymills 0:4c0fca059a0a 43 long timer = 0;
ashleymills 0:4c0fca059a0a 44 while(spos<seqLen) {
ashleymills 0:4c0fca059a0a 45 if(readable()) {
ashleymills 0:4c0fca059a0a 46 int c = getc();
ashleymills 0:4c0fca059a0a 47 //printf("read %x\r\n",c);
ashleymills 0:4c0fca059a0a 48 if(seq[spos]==c) {
ashleymills 0:4c0fca059a0a 49 spos++;
ashleymills 0:4c0fca059a0a 50 } else {
ashleymills 0:4c0fca059a0a 51 return false;
ashleymills 0:4c0fca059a0a 52 }
ashleymills 0:4c0fca059a0a 53 } else {
ashleymills 0:4c0fca059a0a 54 if(timer<timeout) {
ashleymills 0:4c0fca059a0a 55 timer++;
ashleymills 0:4c0fca059a0a 56 } else {
ashleymills 0:4c0fca059a0a 57 printf("timeout\r\n");
ashleymills 0:4c0fca059a0a 58 return false;
ashleymills 0:4c0fca059a0a 59 }
ashleymills 0:4c0fca059a0a 60 }
ashleymills 0:4c0fca059a0a 61 }
ashleymills 0:4c0fca059a0a 62 return true;
ashleymills 0:4c0fca059a0a 63 }
ashleymills 0:4c0fca059a0a 64
ashleymills 0:4c0fca059a0a 65 bool Y201::waitForInt(int bytes, int *fileSize) {
ashleymills 0:4c0fca059a0a 66 int spos = 0;
ashleymills 1:30a6aeda21c2 67 long timeout = 1000000000;
ashleymills 0:4c0fca059a0a 68 long timer = 0;
ashleymills 0:4c0fca059a0a 69 *fileSize = 0;
ashleymills 0:4c0fca059a0a 70 while(spos<bytes) {
ashleymills 0:4c0fca059a0a 71 if(readable()) {
ashleymills 0:4c0fca059a0a 72 uint8_t val = getc();
ashleymills 0:4c0fca059a0a 73 if(spos==0) {
ashleymills 0:4c0fca059a0a 74 *fileSize += (val<<8);
ashleymills 0:4c0fca059a0a 75 } else {
ashleymills 0:4c0fca059a0a 76 *fileSize += val;
ashleymills 0:4c0fca059a0a 77 }
ashleymills 0:4c0fca059a0a 78
ashleymills 0:4c0fca059a0a 79 spos++;
ashleymills 0:4c0fca059a0a 80
ashleymills 0:4c0fca059a0a 81 } else {
ashleymills 0:4c0fca059a0a 82 if(timer<timeout) {
ashleymills 0:4c0fca059a0a 83 timer++;
ashleymills 0:4c0fca059a0a 84 } else {
ashleymills 1:30a6aeda21c2 85 return false;
ashleymills 0:4c0fca059a0a 86 }
ashleymills 0:4c0fca059a0a 87 }
ashleymills 0:4c0fca059a0a 88 }
ashleymills 0:4c0fca059a0a 89 return true;
ashleymills 0:4c0fca059a0a 90 }
ashleymills 0:4c0fca059a0a 91
ashleymills 0:4c0fca059a0a 92 void Y201::putSeq(const int *seq, int seqLen) {
ashleymills 0:4c0fca059a0a 93 while(seqLen--) {
ashleymills 0:4c0fca059a0a 94 //printf("sent %x\r\n",*seq);
ashleymills 0:4c0fca059a0a 95 putc(*seq++);
ashleymills 0:4c0fca059a0a 96 }
ashleymills 0:4c0fca059a0a 97 }
ashleymills 0:4c0fca059a0a 98
ashleymills 2:7d8a6087f2e5 99 Y201::Y201(PinName tx, PinName rx, const char *name) : MODSERIAL(tx,rx,name) {
ashleymills 0:4c0fca059a0a 100 baud(38400);
ashleymills 0:4c0fca059a0a 101 }
ashleymills 0:4c0fca059a0a 102
ashleymills 0:4c0fca059a0a 103 bool Y201::setImageSize(Y201ImageSize size) {
ashleymills 0:4c0fca059a0a 104 switch(size) {
ashleymills 0:4c0fca059a0a 105 case Y201::e640x480:
ashleymills 0:4c0fca059a0a 106 putSeq(set640x480,setSizeLen);
ashleymills 0:4c0fca059a0a 107 break;
ashleymills 0:4c0fca059a0a 108
ashleymills 0:4c0fca059a0a 109 case Y201::e160x120:
ashleymills 0:4c0fca059a0a 110 putSeq(set160x120,setSizeLen);
ashleymills 0:4c0fca059a0a 111 break;
ashleymills 0:4c0fca059a0a 112
ashleymills 0:4c0fca059a0a 113 case Y201::e320x240:
ashleymills 0:4c0fca059a0a 114 putSeq(set320x240,setSizeLen);
ashleymills 0:4c0fca059a0a 115 break;
ashleymills 0:4c0fca059a0a 116 }
ashleymills 0:4c0fca059a0a 117 return waitFor(setSizeAck,setSizeAckLen);
ashleymills 0:4c0fca059a0a 118 }
ashleymills 0:4c0fca059a0a 119
ashleymills 0:4c0fca059a0a 120 bool Y201::takePicture() {
ashleymills 0:4c0fca059a0a 121 putSeq(takePicSeq,takePicSeqLen);
ashleymills 0:4c0fca059a0a 122 Thread::wait(50);
ashleymills 0:4c0fca059a0a 123 return waitFor(takePicSeqAck,takePicSeqAckLen);
ashleymills 0:4c0fca059a0a 124 }
ashleymills 0:4c0fca059a0a 125
ashleymills 0:4c0fca059a0a 126 bool Y201::readImageSize(int *fileSize) {
ashleymills 0:4c0fca059a0a 127 putSeq(readFileSize,readFileSizeLen);
ashleymills 0:4c0fca059a0a 128 bool ret = waitFor(readFileSizeAck,readFileSizeAckLen);
ashleymills 0:4c0fca059a0a 129 if(!ret)
ashleymills 0:4c0fca059a0a 130 return false;
ashleymills 0:4c0fca059a0a 131 return waitForInt(2,fileSize);
ashleymills 0:4c0fca059a0a 132 }
ashleymills 0:4c0fca059a0a 133
ashleymills 0:4c0fca059a0a 134 bool Y201::reset() {
ashleymills 0:4c0fca059a0a 135 putSeq(resetSeq,resetSeqLen);
ashleymills 0:4c0fca059a0a 136 bool ret = waitFor(resetSeqAck,resetSeqAckLen);
ashleymills 0:4c0fca059a0a 137
ashleymills 0:4c0fca059a0a 138 // wait for trash
ashleymills 0:4c0fca059a0a 139 int count = 3;
ashleymills 0:4c0fca059a0a 140 printf("Waiting ");
ashleymills 0:4c0fca059a0a 141 while(count) {
ashleymills 0:4c0fca059a0a 142 printf("%d ",count);
ashleymills 0:4c0fca059a0a 143 count--;
ashleymills 0:4c0fca059a0a 144 if(readable()) {
ashleymills 0:4c0fca059a0a 145 while(readable()) {
ashleymills 0:4c0fca059a0a 146 int c = getc();
ashleymills 0:4c0fca059a0a 147 printf("READ %x\r\n",c);
ashleymills 0:4c0fca059a0a 148 }
ashleymills 0:4c0fca059a0a 149 }
ashleymills 0:4c0fca059a0a 150 Thread::wait(1000);
ashleymills 0:4c0fca059a0a 151 }
ashleymills 0:4c0fca059a0a 152 printf("done.\r\n");
ashleymills 0:4c0fca059a0a 153 return ret;
ashleymills 0:4c0fca059a0a 154 }