Dhruv Bhatt / Mbed 2 deprecated final_proj1

Bank Account Security System

Dependencies:   FatFileSystemSD mbed

Camera_LS_Y201.cpp@0:7e4786a3584b, 2012-10-11 (annotated)

Committer:
Dhruv_Varun
Date:
Thu Oct 11 20:49:25 2012 +0000
Revision:
0:7e4786a3584b
Code For Bank Account Security System

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Dhruv_Varun 0:7e4786a3584b 1 /**
Dhruv_Varun 0:7e4786a3584b 2 * =============================================================================
Dhruv_Varun 0:7e4786a3584b 3 * LS-Y201 device driver class (Version 0.0.1)
Dhruv_Varun 0:7e4786a3584b 4 * Reference documents: LinkSprite JPEG Color Camera Serial UART Interface
Dhruv_Varun 0:7e4786a3584b 5 * January 2010
Dhruv_Varun 0:7e4786a3584b 6 * =============================================================================
Dhruv_Varun 0:7e4786a3584b 7 * Copyright (c) 2010 Shinichiro Nakamura (CuBeatSystems)
Dhruv_Varun 0:7e4786a3584b 8 *
Dhruv_Varun 0:7e4786a3584b 9 * Permission is hereby granted, free of charge, to any person obtaining a copy
Dhruv_Varun 0:7e4786a3584b 10 * of this software and associated documentation files (the "Software"), to deal
Dhruv_Varun 0:7e4786a3584b 11 * in the Software without restriction, including without limitation the rights
Dhruv_Varun 0:7e4786a3584b 12 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
Dhruv_Varun 0:7e4786a3584b 13 * copies of the Software, and to permit persons to whom the Software is
Dhruv_Varun 0:7e4786a3584b 14 * furnished to do so, subject to the following conditions:
Dhruv_Varun 0:7e4786a3584b 15 *
Dhruv_Varun 0:7e4786a3584b 16 * The above copyright notice and this permission notice shall be included in
Dhruv_Varun 0:7e4786a3584b 17 * all copies or substantial portions of the Software.
Dhruv_Varun 0:7e4786a3584b 18 *
Dhruv_Varun 0:7e4786a3584b 19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
Dhruv_Varun 0:7e4786a3584b 20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
Dhruv_Varun 0:7e4786a3584b 21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
Dhruv_Varun 0:7e4786a3584b 22 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
Dhruv_Varun 0:7e4786a3584b 23 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
Dhruv_Varun 0:7e4786a3584b 24 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
Dhruv_Varun 0:7e4786a3584b 25 * THE SOFTWARE.
Dhruv_Varun 0:7e4786a3584b 26 * =============================================================================
Dhruv_Varun 0:7e4786a3584b 27 */
Dhruv_Varun 0:7e4786a3584b 28
Dhruv_Varun 0:7e4786a3584b 29 #include "Camera_LS_Y201.h"
Dhruv_Varun 0:7e4786a3584b 30
Dhruv_Varun 0:7e4786a3584b 31 /**
Dhruv_Varun 0:7e4786a3584b 32 * Create.
Dhruv_Varun 0:7e4786a3584b 33 *
Dhruv_Varun 0:7e4786a3584b 34 * @param tx Transmitter.
Dhruv_Varun 0:7e4786a3584b 35 * @param rx Receiver.
Dhruv_Varun 0:7e4786a3584b 36 */
Dhruv_Varun 0:7e4786a3584b 37 Camera_LS_Y201::Camera_LS_Y201(PinName tx, PinName rx) : serial(tx, rx) {
Dhruv_Varun 0:7e4786a3584b 38 serial.baud(38400);
Dhruv_Varun 0:7e4786a3584b 39 }
Dhruv_Varun 0:7e4786a3584b 40
Dhruv_Varun 0:7e4786a3584b 41 /**
Dhruv_Varun 0:7e4786a3584b 42 * Dispose.
Dhruv_Varun 0:7e4786a3584b 43 */
Dhruv_Varun 0:7e4786a3584b 44 Camera_LS_Y201::~Camera_LS_Y201() {
Dhruv_Varun 0:7e4786a3584b 45 }
Dhruv_Varun 0:7e4786a3584b 46
Dhruv_Varun 0:7e4786a3584b 47 /**
Dhruv_Varun 0:7e4786a3584b 48 * Reset module.
Dhruv_Varun 0:7e4786a3584b 49 *
Dhruv_Varun 0:7e4786a3584b 50 * @return Error code.
Dhruv_Varun 0:7e4786a3584b 51 */
Dhruv_Varun 0:7e4786a3584b 52 Camera_LS_Y201::ErrorCode Camera_LS_Y201::reset() {
Dhruv_Varun 0:7e4786a3584b 53 uint8_t send[4] = {
Dhruv_Varun 0:7e4786a3584b 54 0x56,
Dhruv_Varun 0:7e4786a3584b 55 0x00,
Dhruv_Varun 0:7e4786a3584b 56 0x26,
Dhruv_Varun 0:7e4786a3584b 57 0x00
Dhruv_Varun 0:7e4786a3584b 58 };
Dhruv_Varun 0:7e4786a3584b 59 uint8_t recv[4];
Dhruv_Varun 0:7e4786a3584b 60
Dhruv_Varun 0:7e4786a3584b 61 waitIdle();
Dhruv_Varun 0:7e4786a3584b 62 if (!sendBytes(send, sizeof(send), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 63 return SendError;
Dhruv_Varun 0:7e4786a3584b 64 }
Dhruv_Varun 0:7e4786a3584b 65 if (!recvBytes(recv, sizeof(recv), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 66 return RecvError;
Dhruv_Varun 0:7e4786a3584b 67 }
Dhruv_Varun 0:7e4786a3584b 68 if ((recv[0] == 0x76)
Dhruv_Varun 0:7e4786a3584b 69 && (recv[1] == 0x00)
Dhruv_Varun 0:7e4786a3584b 70 && (recv[2] == 0x26)
Dhruv_Varun 0:7e4786a3584b 71 && (recv[3] == 0x00)) {
Dhruv_Varun 0:7e4786a3584b 72 ErrorCode r = waitInitEnd();
Dhruv_Varun 0:7e4786a3584b 73 if (r != NoError) {
Dhruv_Varun 0:7e4786a3584b 74 return r;
Dhruv_Varun 0:7e4786a3584b 75 }
Dhruv_Varun 0:7e4786a3584b 76 wait(4);
Dhruv_Varun 0:7e4786a3584b 77 return NoError;
Dhruv_Varun 0:7e4786a3584b 78 } else {
Dhruv_Varun 0:7e4786a3584b 79 return UnexpectedReply;
Dhruv_Varun 0:7e4786a3584b 80 }
Dhruv_Varun 0:7e4786a3584b 81 }
Dhruv_Varun 0:7e4786a3584b 82
Dhruv_Varun 0:7e4786a3584b 83 /**
Dhruv_Varun 0:7e4786a3584b 84 * Set image size.
Dhruv_Varun 0:7e4786a3584b 85 *
Dhruv_Varun 0:7e4786a3584b 86 * @param is Image size.
Dhruv_Varun 0:7e4786a3584b 87 * @return Error code.
Dhruv_Varun 0:7e4786a3584b 88 */
Dhruv_Varun 0:7e4786a3584b 89 Camera_LS_Y201::ErrorCode Camera_LS_Y201::setImageSize(ImageSize is) {
Dhruv_Varun 0:7e4786a3584b 90 uint8_t send[9] = {
Dhruv_Varun 0:7e4786a3584b 91 0x56,
Dhruv_Varun 0:7e4786a3584b 92 0x00,
Dhruv_Varun 0:7e4786a3584b 93 0x31,
Dhruv_Varun 0:7e4786a3584b 94 0x05,
Dhruv_Varun 0:7e4786a3584b 95 0x04,
Dhruv_Varun 0:7e4786a3584b 96 0x01,
Dhruv_Varun 0:7e4786a3584b 97 0x00,
Dhruv_Varun 0:7e4786a3584b 98 0x19,
Dhruv_Varun 0:7e4786a3584b 99 0x00 // 0x11:320x240, 0x00:640x480, 0x22:160x120
Dhruv_Varun 0:7e4786a3584b 100 };
Dhruv_Varun 0:7e4786a3584b 101 uint8_t recv[5];
Dhruv_Varun 0:7e4786a3584b 102 switch (is) {
Dhruv_Varun 0:7e4786a3584b 103 case ImageSize160x120:
Dhruv_Varun 0:7e4786a3584b 104 send[8] = 0x22;
Dhruv_Varun 0:7e4786a3584b 105 break;
Dhruv_Varun 0:7e4786a3584b 106 case ImageSize320x280:
Dhruv_Varun 0:7e4786a3584b 107 send[8] = 0x11;
Dhruv_Varun 0:7e4786a3584b 108 break;
Dhruv_Varun 0:7e4786a3584b 109 case ImageSize640x480:
Dhruv_Varun 0:7e4786a3584b 110 send[8] = 0x00;
Dhruv_Varun 0:7e4786a3584b 111 break;
Dhruv_Varun 0:7e4786a3584b 112 default:
Dhruv_Varun 0:7e4786a3584b 113 return InvalidArguments;
Dhruv_Varun 0:7e4786a3584b 114 }
Dhruv_Varun 0:7e4786a3584b 115 if (!sendBytes(send, sizeof(send), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 116 return SendError;
Dhruv_Varun 0:7e4786a3584b 117 }
Dhruv_Varun 0:7e4786a3584b 118 if (!recvBytes(recv, sizeof(recv), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 119 return RecvError;
Dhruv_Varun 0:7e4786a3584b 120 }
Dhruv_Varun 0:7e4786a3584b 121 if ((recv[0] == 0x76)
Dhruv_Varun 0:7e4786a3584b 122 && (recv[1] == 0x00)
Dhruv_Varun 0:7e4786a3584b 123 && (recv[2] == 0x31)
Dhruv_Varun 0:7e4786a3584b 124 && (recv[3] == 0x00)
Dhruv_Varun 0:7e4786a3584b 125 && (recv[4] == 0x00)) {
Dhruv_Varun 0:7e4786a3584b 126 wait(1);
Dhruv_Varun 0:7e4786a3584b 127 return reset();
Dhruv_Varun 0:7e4786a3584b 128 } else {
Dhruv_Varun 0:7e4786a3584b 129 return UnexpectedReply;
Dhruv_Varun 0:7e4786a3584b 130 }
Dhruv_Varun 0:7e4786a3584b 131 }
Dhruv_Varun 0:7e4786a3584b 132
Dhruv_Varun 0:7e4786a3584b 133 /**
Dhruv_Varun 0:7e4786a3584b 134 * Take picture.
Dhruv_Varun 0:7e4786a3584b 135 *
Dhruv_Varun 0:7e4786a3584b 136 * @return Error code.
Dhruv_Varun 0:7e4786a3584b 137 */
Dhruv_Varun 0:7e4786a3584b 138 Camera_LS_Y201::ErrorCode Camera_LS_Y201::takePicture() {
Dhruv_Varun 0:7e4786a3584b 139 uint8_t send[5] = {
Dhruv_Varun 0:7e4786a3584b 140 0x56,
Dhruv_Varun 0:7e4786a3584b 141 0x00,
Dhruv_Varun 0:7e4786a3584b 142 0x36,
Dhruv_Varun 0:7e4786a3584b 143 0x01,
Dhruv_Varun 0:7e4786a3584b 144 0x00
Dhruv_Varun 0:7e4786a3584b 145 };
Dhruv_Varun 0:7e4786a3584b 146 uint8_t recv[5];
Dhruv_Varun 0:7e4786a3584b 147
Dhruv_Varun 0:7e4786a3584b 148 if (!sendBytes(send, sizeof(send), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 149 return SendError;
Dhruv_Varun 0:7e4786a3584b 150 }
Dhruv_Varun 0:7e4786a3584b 151 if (!recvBytes(recv, sizeof(recv), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 152 return RecvError;
Dhruv_Varun 0:7e4786a3584b 153 }
Dhruv_Varun 0:7e4786a3584b 154
Dhruv_Varun 0:7e4786a3584b 155 if ((recv[0] == 0x76)
Dhruv_Varun 0:7e4786a3584b 156 && (recv[1] == 0x00)
Dhruv_Varun 0:7e4786a3584b 157 && (recv[2] == 0x36)
Dhruv_Varun 0:7e4786a3584b 158 && (recv[3] == 0x00)
Dhruv_Varun 0:7e4786a3584b 159 && (recv[4] == 0x00)) {
Dhruv_Varun 0:7e4786a3584b 160 /*
Dhruv_Varun 0:7e4786a3584b 161 * I think the camera need a time for operating.
Dhruv_Varun 0:7e4786a3584b 162 * But there is no any comments on the documents.
Dhruv_Varun 0:7e4786a3584b 163 */
Dhruv_Varun 0:7e4786a3584b 164 wait_ms(100);
Dhruv_Varun 0:7e4786a3584b 165 return NoError;
Dhruv_Varun 0:7e4786a3584b 166 } else {
Dhruv_Varun 0:7e4786a3584b 167 return UnexpectedReply;
Dhruv_Varun 0:7e4786a3584b 168 }
Dhruv_Varun 0:7e4786a3584b 169 }
Dhruv_Varun 0:7e4786a3584b 170
Dhruv_Varun 0:7e4786a3584b 171 /**
Dhruv_Varun 0:7e4786a3584b 172 * Read jpeg file size.
Dhruv_Varun 0:7e4786a3584b 173 *
Dhruv_Varun 0:7e4786a3584b 174 * @param fileSize File size.
Dhruv_Varun 0:7e4786a3584b 175 * @return Error code.
Dhruv_Varun 0:7e4786a3584b 176 */
Dhruv_Varun 0:7e4786a3584b 177 Camera_LS_Y201::ErrorCode Camera_LS_Y201::readJpegFileSize(int *fileSize) {
Dhruv_Varun 0:7e4786a3584b 178 uint8_t send[5] = {
Dhruv_Varun 0:7e4786a3584b 179 0x56,
Dhruv_Varun 0:7e4786a3584b 180 0x00,
Dhruv_Varun 0:7e4786a3584b 181 0x34,
Dhruv_Varun 0:7e4786a3584b 182 0x01,
Dhruv_Varun 0:7e4786a3584b 183 0x00
Dhruv_Varun 0:7e4786a3584b 184 };
Dhruv_Varun 0:7e4786a3584b 185 uint8_t recv[9];
Dhruv_Varun 0:7e4786a3584b 186
Dhruv_Varun 0:7e4786a3584b 187 if (!sendBytes(send, sizeof(send), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 188 return SendError;
Dhruv_Varun 0:7e4786a3584b 189 }
Dhruv_Varun 0:7e4786a3584b 190 if (!recvBytes(recv, sizeof(recv), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 191 return RecvError;
Dhruv_Varun 0:7e4786a3584b 192 }
Dhruv_Varun 0:7e4786a3584b 193
Dhruv_Varun 0:7e4786a3584b 194 if ((recv[0] == 0x76)
Dhruv_Varun 0:7e4786a3584b 195 && (recv[1] == 0x00)
Dhruv_Varun 0:7e4786a3584b 196 && (recv[2] == 0x34)
Dhruv_Varun 0:7e4786a3584b 197 && (recv[3] == 0x00)
Dhruv_Varun 0:7e4786a3584b 198 && (recv[4] == 0x04)
Dhruv_Varun 0:7e4786a3584b 199 && (recv[5] == 0x00)
Dhruv_Varun 0:7e4786a3584b 200 && (recv[6] == 0x00)) {
Dhruv_Varun 0:7e4786a3584b 201 *fileSize = ((recv[7] & 0x00ff) << 8)
Dhruv_Varun 0:7e4786a3584b 202 | ((recv[8] & 0x00ff) << 0);
Dhruv_Varun 0:7e4786a3584b 203 return NoError;
Dhruv_Varun 0:7e4786a3584b 204 } else {
Dhruv_Varun 0:7e4786a3584b 205 return UnexpectedReply;
Dhruv_Varun 0:7e4786a3584b 206 }
Dhruv_Varun 0:7e4786a3584b 207 }
Dhruv_Varun 0:7e4786a3584b 208
Dhruv_Varun 0:7e4786a3584b 209 /**
Dhruv_Varun 0:7e4786a3584b 210 * Read jpeg file content.
Dhruv_Varun 0:7e4786a3584b 211 *
Dhruv_Varun 0:7e4786a3584b 212 * @param func A pointer to a call back function.
Dhruv_Varun 0:7e4786a3584b 213 * @return Error code.
Dhruv_Varun 0:7e4786a3584b 214 */
Dhruv_Varun 0:7e4786a3584b 215 Camera_LS_Y201::ErrorCode Camera_LS_Y201::readJpegFileContent(void (*func)(int done, int total, uint8_t *buf, size_t siz)) {
Dhruv_Varun 0:7e4786a3584b 216 uint8_t send[16] = {
Dhruv_Varun 0:7e4786a3584b 217 0x56,
Dhruv_Varun 0:7e4786a3584b 218 0x00,
Dhruv_Varun 0:7e4786a3584b 219 0x32,
Dhruv_Varun 0:7e4786a3584b 220 0x0C,
Dhruv_Varun 0:7e4786a3584b 221 0x00,
Dhruv_Varun 0:7e4786a3584b 222 0x0A,
Dhruv_Varun 0:7e4786a3584b 223 0x00,
Dhruv_Varun 0:7e4786a3584b 224 0x00,
Dhruv_Varun 0:7e4786a3584b 225 0x00, // MH
Dhruv_Varun 0:7e4786a3584b 226 0x00, // ML
Dhruv_Varun 0:7e4786a3584b 227 0x00,
Dhruv_Varun 0:7e4786a3584b 228 0x00,
Dhruv_Varun 0:7e4786a3584b 229 0x00, // KH
Dhruv_Varun 0:7e4786a3584b 230 0x00, // KL
Dhruv_Varun 0:7e4786a3584b 231 0x00, // XX
Dhruv_Varun 0:7e4786a3584b 232 0x00 // XX
Dhruv_Varun 0:7e4786a3584b 233 };
Dhruv_Varun 0:7e4786a3584b 234 uint8_t body[32];
Dhruv_Varun 0:7e4786a3584b 235 uint16_t m = 0; // Staring address.
Dhruv_Varun 0:7e4786a3584b 236 uint16_t k = sizeof(body); // Packet size.
Dhruv_Varun 0:7e4786a3584b 237 uint16_t x = 10; // Interval time. XX XX * 0.01m[sec]
Dhruv_Varun 0:7e4786a3584b 238 bool end = false;
Dhruv_Varun 0:7e4786a3584b 239
Dhruv_Varun 0:7e4786a3584b 240 /*
Dhruv_Varun 0:7e4786a3584b 241 * Get the data size.
Dhruv_Varun 0:7e4786a3584b 242 */
Dhruv_Varun 0:7e4786a3584b 243 int siz_done = 0;
Dhruv_Varun 0:7e4786a3584b 244 int siz_total = 0;
Dhruv_Varun 0:7e4786a3584b 245 ErrorCode r = readJpegFileSize(&siz_total);
Dhruv_Varun 0:7e4786a3584b 246 if (r != NoError) {
Dhruv_Varun 0:7e4786a3584b 247 return r;
Dhruv_Varun 0:7e4786a3584b 248 }
Dhruv_Varun 0:7e4786a3584b 249
Dhruv_Varun 0:7e4786a3584b 250 do {
Dhruv_Varun 0:7e4786a3584b 251 send[8] = (m >> 8) & 0xff;
Dhruv_Varun 0:7e4786a3584b 252 send[9] = (m >> 0) & 0xff;
Dhruv_Varun 0:7e4786a3584b 253 send[12] = (k >> 8) & 0xff;
Dhruv_Varun 0:7e4786a3584b 254 send[13] = (k >> 0) & 0xff;
Dhruv_Varun 0:7e4786a3584b 255 send[14] = (x >> 8) & 0xff;
Dhruv_Varun 0:7e4786a3584b 256 send[15] = (x >> 0) & 0xff;
Dhruv_Varun 0:7e4786a3584b 257 /*
Dhruv_Varun 0:7e4786a3584b 258 * Send a command.
Dhruv_Varun 0:7e4786a3584b 259 */
Dhruv_Varun 0:7e4786a3584b 260 if (!sendBytes(send, sizeof(send), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 261 return SendError;
Dhruv_Varun 0:7e4786a3584b 262 }
Dhruv_Varun 0:7e4786a3584b 263 /*
Dhruv_Varun 0:7e4786a3584b 264 * Read the header of the response.
Dhruv_Varun 0:7e4786a3584b 265 */
Dhruv_Varun 0:7e4786a3584b 266 uint8_t header[5];
Dhruv_Varun 0:7e4786a3584b 267 if (!recvBytes(header, sizeof(header), 2 * 1000 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 268 return RecvError;
Dhruv_Varun 0:7e4786a3584b 269 }
Dhruv_Varun 0:7e4786a3584b 270 /*
Dhruv_Varun 0:7e4786a3584b 271 * Check the response and fetch an image data.
Dhruv_Varun 0:7e4786a3584b 272 */
Dhruv_Varun 0:7e4786a3584b 273 if ((header[0] == 0x76)
Dhruv_Varun 0:7e4786a3584b 274 && (header[1] == 0x00)
Dhruv_Varun 0:7e4786a3584b 275 && (header[2] == 0x32)
Dhruv_Varun 0:7e4786a3584b 276 && (header[3] == 0x00)
Dhruv_Varun 0:7e4786a3584b 277 && (header[4] == 0x00)) {
Dhruv_Varun 0:7e4786a3584b 278 if (!recvBytes(body, sizeof(body), 2 * 1000 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 279 return RecvError;
Dhruv_Varun 0:7e4786a3584b 280 }
Dhruv_Varun 0:7e4786a3584b 281 siz_done += sizeof(body);
Dhruv_Varun 0:7e4786a3584b 282 if (func != NULL) {
Dhruv_Varun 0:7e4786a3584b 283 if (siz_done > siz_total) {
Dhruv_Varun 0:7e4786a3584b 284 siz_done = siz_total;
Dhruv_Varun 0:7e4786a3584b 285 }
Dhruv_Varun 0:7e4786a3584b 286 func(siz_done, siz_total, body, sizeof(body));
Dhruv_Varun 0:7e4786a3584b 287 }
Dhruv_Varun 0:7e4786a3584b 288 for (int i = 1; i < sizeof(body); i++) {
Dhruv_Varun 0:7e4786a3584b 289 if ((body[i - 1] == 0xFF) && (body[i - 0] == 0xD9)) {
Dhruv_Varun 0:7e4786a3584b 290 end = true;
Dhruv_Varun 0:7e4786a3584b 291 }
Dhruv_Varun 0:7e4786a3584b 292 }
Dhruv_Varun 0:7e4786a3584b 293 } else {
Dhruv_Varun 0:7e4786a3584b 294 return UnexpectedReply;
Dhruv_Varun 0:7e4786a3584b 295 }
Dhruv_Varun 0:7e4786a3584b 296 /*
Dhruv_Varun 0:7e4786a3584b 297 * Read the footer of the response.
Dhruv_Varun 0:7e4786a3584b 298 */
Dhruv_Varun 0:7e4786a3584b 299 uint8_t footer[5];
Dhruv_Varun 0:7e4786a3584b 300 if (!recvBytes(footer, sizeof(footer), 2 * 1000 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 301 return RecvError;
Dhruv_Varun 0:7e4786a3584b 302 }
Dhruv_Varun 0:7e4786a3584b 303
Dhruv_Varun 0:7e4786a3584b 304 m += sizeof(body);
Dhruv_Varun 0:7e4786a3584b 305 } while (!end);
Dhruv_Varun 0:7e4786a3584b 306 return NoError;
Dhruv_Varun 0:7e4786a3584b 307 }
Dhruv_Varun 0:7e4786a3584b 308
Dhruv_Varun 0:7e4786a3584b 309 /**
Dhruv_Varun 0:7e4786a3584b 310 * Stop taking pictures.
Dhruv_Varun 0:7e4786a3584b 311 *
Dhruv_Varun 0:7e4786a3584b 312 * @return Error code.
Dhruv_Varun 0:7e4786a3584b 313 */
Dhruv_Varun 0:7e4786a3584b 314 Camera_LS_Y201::ErrorCode Camera_LS_Y201::stopTakingPictures() {
Dhruv_Varun 0:7e4786a3584b 315 uint8_t send[5] = {
Dhruv_Varun 0:7e4786a3584b 316 0x56,
Dhruv_Varun 0:7e4786a3584b 317 0x00,
Dhruv_Varun 0:7e4786a3584b 318 0x36,
Dhruv_Varun 0:7e4786a3584b 319 0x01,
Dhruv_Varun 0:7e4786a3584b 320 0x03
Dhruv_Varun 0:7e4786a3584b 321 };
Dhruv_Varun 0:7e4786a3584b 322 uint8_t recv[5];
Dhruv_Varun 0:7e4786a3584b 323
Dhruv_Varun 0:7e4786a3584b 324 if (!sendBytes(send, sizeof(send), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 325 return SendError;
Dhruv_Varun 0:7e4786a3584b 326 }
Dhruv_Varun 0:7e4786a3584b 327 if (!recvBytes(recv, sizeof(recv), 200 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 328 return RecvError;
Dhruv_Varun 0:7e4786a3584b 329 }
Dhruv_Varun 0:7e4786a3584b 330
Dhruv_Varun 0:7e4786a3584b 331 if ((recv[0] == 0x76)
Dhruv_Varun 0:7e4786a3584b 332 && (recv[1] == 0x00)
Dhruv_Varun 0:7e4786a3584b 333 && (recv[2] == 0x36)
Dhruv_Varun 0:7e4786a3584b 334 && (recv[3] == 0x00)
Dhruv_Varun 0:7e4786a3584b 335 && (recv[4] == 0x00)) {
Dhruv_Varun 0:7e4786a3584b 336 /*
Dhruv_Varun 0:7e4786a3584b 337 * I think the camera need a time for operating.
Dhruv_Varun 0:7e4786a3584b 338 * But there is no any comments on the documents.
Dhruv_Varun 0:7e4786a3584b 339 */
Dhruv_Varun 0:7e4786a3584b 340 wait_ms(100);
Dhruv_Varun 0:7e4786a3584b 341 return NoError;
Dhruv_Varun 0:7e4786a3584b 342 } else {
Dhruv_Varun 0:7e4786a3584b 343 return UnexpectedReply;
Dhruv_Varun 0:7e4786a3584b 344 }
Dhruv_Varun 0:7e4786a3584b 345 }
Dhruv_Varun 0:7e4786a3584b 346
Dhruv_Varun 0:7e4786a3584b 347 /**
Dhruv_Varun 0:7e4786a3584b 348 * Wait init end codes.
Dhruv_Varun 0:7e4786a3584b 349 *
Dhruv_Varun 0:7e4786a3584b 350 * @return True if the data sended.
Dhruv_Varun 0:7e4786a3584b 351 */
Dhruv_Varun 0:7e4786a3584b 352 Camera_LS_Y201::ErrorCode Camera_LS_Y201::waitInitEnd() {
Dhruv_Varun 0:7e4786a3584b 353 static const char *PWR_ON_MSG = "Init end\x0d\x0a";
Dhruv_Varun 0:7e4786a3584b 354 for (int i = 0; i < strlen(PWR_ON_MSG); i++) {
Dhruv_Varun 0:7e4786a3584b 355 static const int MAXCNT = 128;
Dhruv_Varun 0:7e4786a3584b 356 int cnt = 0;
Dhruv_Varun 0:7e4786a3584b 357 uint8_t c = 0x00;
Dhruv_Varun 0:7e4786a3584b 358 do {
Dhruv_Varun 0:7e4786a3584b 359 if (!recvBytes(&c, sizeof(c), 500 * 1000)) {
Dhruv_Varun 0:7e4786a3584b 360 return Timeout;
Dhruv_Varun 0:7e4786a3584b 361 }
Dhruv_Varun 0:7e4786a3584b 362
Dhruv_Varun 0:7e4786a3584b 363 /*
Dhruv_Varun 0:7e4786a3584b 364 * What is the version of the camera.
Dhruv_Varun 0:7e4786a3584b 365 * You can check the version with this code.
Dhruv_Varun 0:7e4786a3584b 366 *
Dhruv_Varun 0:7e4786a3584b 367 * VC0703 1.00
Dhruv_Varun 0:7e4786a3584b 368 * 3o ctrl in
Dhruv_Varun 0:7e4786a3584b 369 * Init end
Dhruv_Varun 0:7e4786a3584b 370 */
Dhruv_Varun 0:7e4786a3584b 371 #if 0
Dhruv_Varun 0:7e4786a3584b 372 printf("%c", c);
Dhruv_Varun 0:7e4786a3584b 373 #endif
Dhruv_Varun 0:7e4786a3584b 374
Dhruv_Varun 0:7e4786a3584b 375 cnt++;
Dhruv_Varun 0:7e4786a3584b 376 if (MAXCNT < cnt) {
Dhruv_Varun 0:7e4786a3584b 377 return UnexpectedReply;
Dhruv_Varun 0:7e4786a3584b 378 }
Dhruv_Varun 0:7e4786a3584b 379 } while (c != PWR_ON_MSG[i]);
Dhruv_Varun 0:7e4786a3584b 380 }
Dhruv_Varun 0:7e4786a3584b 381 return NoError;
Dhruv_Varun 0:7e4786a3584b 382 }
Dhruv_Varun 0:7e4786a3584b 383
Dhruv_Varun 0:7e4786a3584b 384 /**
Dhruv_Varun 0:7e4786a3584b 385 * Send bytes to camera module.
Dhruv_Varun 0:7e4786a3584b 386 *
Dhruv_Varun 0:7e4786a3584b 387 * @param buf Pointer to the data buffer.
Dhruv_Varun 0:7e4786a3584b 388 * @param len Length of the data buffer.
Dhruv_Varun 0:7e4786a3584b 389 *
Dhruv_Varun 0:7e4786a3584b 390 * @return True if the data sended.
Dhruv_Varun 0:7e4786a3584b 391 */
Dhruv_Varun 0:7e4786a3584b 392 bool Camera_LS_Y201::sendBytes(uint8_t *buf, size_t len, int timeout_us) {
Dhruv_Varun 0:7e4786a3584b 393 for (uint32_t i = 0; i < (uint32_t)len; i++) {
Dhruv_Varun 0:7e4786a3584b 394 int cnt = 0;
Dhruv_Varun 0:7e4786a3584b 395 while (!serial.writeable()) {
Dhruv_Varun 0:7e4786a3584b 396 wait_us(1);
Dhruv_Varun 0:7e4786a3584b 397 cnt++;
Dhruv_Varun 0:7e4786a3584b 398 if (timeout_us < cnt) {
Dhruv_Varun 0:7e4786a3584b 399 return false;
Dhruv_Varun 0:7e4786a3584b 400 }
Dhruv_Varun 0:7e4786a3584b 401 }
Dhruv_Varun 0:7e4786a3584b 402 serial.putc(buf[i]);
Dhruv_Varun 0:7e4786a3584b 403 }
Dhruv_Varun 0:7e4786a3584b 404 return true;
Dhruv_Varun 0:7e4786a3584b 405 }
Dhruv_Varun 0:7e4786a3584b 406
Dhruv_Varun 0:7e4786a3584b 407 /**
Dhruv_Varun 0:7e4786a3584b 408 * Receive bytes from camera module.
Dhruv_Varun 0:7e4786a3584b 409 *
Dhruv_Varun 0:7e4786a3584b 410 * @param buf Pointer to the data buffer.
Dhruv_Varun 0:7e4786a3584b 411 * @param len Length of the data buffer.
Dhruv_Varun 0:7e4786a3584b 412 *
Dhruv_Varun 0:7e4786a3584b 413 * @return True if the data received.
Dhruv_Varun 0:7e4786a3584b 414 */
Dhruv_Varun 0:7e4786a3584b 415 bool Camera_LS_Y201::recvBytes(uint8_t *buf, size_t len, int timeout_us) {
Dhruv_Varun 0:7e4786a3584b 416 for (uint32_t i = 0; i < (uint32_t)len; i++) {
Dhruv_Varun 0:7e4786a3584b 417 int cnt = 0;
Dhruv_Varun 0:7e4786a3584b 418 while (!serial.readable()) {
Dhruv_Varun 0:7e4786a3584b 419 wait_us(1);
Dhruv_Varun 0:7e4786a3584b 420 cnt++;
Dhruv_Varun 0:7e4786a3584b 421 if (timeout_us < cnt) {
Dhruv_Varun 0:7e4786a3584b 422 return false;
Dhruv_Varun 0:7e4786a3584b 423 }
Dhruv_Varun 0:7e4786a3584b 424 }
Dhruv_Varun 0:7e4786a3584b 425 buf[i] = serial.getc();
Dhruv_Varun 0:7e4786a3584b 426 }
Dhruv_Varun 0:7e4786a3584b 427 return true;
Dhruv_Varun 0:7e4786a3584b 428 }
Dhruv_Varun 0:7e4786a3584b 429
Dhruv_Varun 0:7e4786a3584b 430 /**
Dhruv_Varun 0:7e4786a3584b 431 * Wait received.
Dhruv_Varun 0:7e4786a3584b 432 *
Dhruv_Varun 0:7e4786a3584b 433 * @return True if the data received.
Dhruv_Varun 0:7e4786a3584b 434 */
Dhruv_Varun 0:7e4786a3584b 435 bool Camera_LS_Y201::waitRecv() {
Dhruv_Varun 0:7e4786a3584b 436 while (!serial.readable()) {
Dhruv_Varun 0:7e4786a3584b 437 }
Dhruv_Varun 0:7e4786a3584b 438 return true;
Dhruv_Varun 0:7e4786a3584b 439 }
Dhruv_Varun 0:7e4786a3584b 440
Dhruv_Varun 0:7e4786a3584b 441 /**
Dhruv_Varun 0:7e4786a3584b 442 * Wait idle state.
Dhruv_Varun 0:7e4786a3584b 443 */
Dhruv_Varun 0:7e4786a3584b 444 bool Camera_LS_Y201::waitIdle() {
Dhruv_Varun 0:7e4786a3584b 445 while (serial.readable()) {
Dhruv_Varun 0:7e4786a3584b 446 serial.getc();
Dhruv_Varun 0:7e4786a3584b 447 }
Dhruv_Varun 0:7e4786a3584b 448 return true;
Dhruv_Varun 0:7e4786a3584b 449 }