智也 大野 / Camera_LS_Y201

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of Camera_LS_Y201 by Shinichiro Nakamura

Camera_LS_Y201.cpp@0:f71232252dcf, 2010-11-25 (annotated)

Committer:
shintamainjp
Date:
Thu Nov 25 15:43:42 2010 +0000
Revision:
0:f71232252dcf
Child:
1:43358d40f879
Initial version.

Who changed what in which revision?

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