CameraC328
Dependents: CameraC328_TestProgram CameraC328_Thresholding Camera_TestProgram_2015 Camera_TestProgram_2015 ... more
Diff: main.cpp
- Revision:
- 3:6d3150d4396a
- Parent:
- 2:6a72fcad5c0a
- Child:
- 4:ad06342d4b84
--- a/main.cpp Mon Jun 28 13:57:15 2010 +0000 +++ b/main.cpp Tue Jun 29 11:45:53 2010 +0000 @@ -1,72 +1,136 @@ -#include "mbed.h" -#include "CameraC328.h" - -DigitalOut myled1(LED1); -DigitalOut myled2(LED2); -CameraC328 camera(p9, p10); -Serial serial(USBTX, USBRX); -LocalFileSystem fs ("fs"); -const int IMG_X = 80; -const int IMG_Y = 60; -char buf[IMG_X * IMG_Y * 2]; - -void cbfunc(size_t done, size_t total, char c) { - buf[done - 1] = c; -} - -int main() { - serial.baud(19200); - serial.printf("\n"); - serial.printf("==========\n"); - serial.printf("CameraC328\n"); - serial.printf("==========\n"); - CameraC328::ErrorNumber err = CameraC328::NoError; - - err = camera.sync(); - if (CameraC328::NoError == err) { - serial.printf("[ OK ] : CameraC328::sync\n"); - } else { - serial.printf("[FAIL] : CameraC328::sync (Error=%02X)\n", (int)err); - } - - err = camera.init(CameraC328::Color16bit, CameraC328::RawResolution80x60, CameraC328::JpegResolution80x64); - if (CameraC328::NoError == err) { - serial.printf("[ OK ] : CameraC328::init\n"); - } else { - serial.printf("[FAIL] : CameraC328::init (Error=%02X)\n", (int)err); - } - - err = camera.getJpegSnapshotPicture(cbfunc); - if (CameraC328::NoError == err) { - serial.printf("[ OK ] : CameraC328::getPicture(PreviewPicture)\n"); - } else { - serial.printf("[FAIL] : CameraC328::getPicture(PreviewPicture) (Error=%02X)\n", (int)err); - } - - FILE *fp = fopen("/fs/img.ppm","w"); - fprintf(fp, "P3\n"); - fprintf(fp, "%d %d\n", IMG_X, IMG_Y); - fprintf(fp, "%d\n", 255); - for (int y = 0; y < IMG_Y; y++) { - for (int x = 0; x < IMG_X; x++) { - int adrofs = y * (IMG_X * 2) + (x * 2); - uint16_t dat = (buf[adrofs + 0] << 8) | (buf[adrofs + 1] << 0); - uint8_t r = ((dat >> 11) & 0x1f) << 3; - uint8_t g = ((dat >> 5) & 0x3f) << 2; - uint8_t b = ((dat >> 0) & 0x1f) << 3; - fprintf(fp,"%d %d %d\n", r, g, b); - } - } - fclose(fp); - - while (1) { - myled1 = 1; - wait(0.2); - myled1 = 0; - wait(0.2); - myled2 = 1; - wait(0.2); - myled2 = 0; - wait(0.2); - } -} +/** + * C328-7640 device driver test program + * Reference documents: C328-7640 User Manual v3.0 2004.8.19 + * + * Version 0.0.1 + * + * Copyright (C) 2010 Shinichiro Nakamura (CuBeatSystems) + * shinta.main.jp@gmail.com + * http://shinta.main.jp/ + */ + +#include "mbed.h" +#include "CameraC328.h" + +DigitalOut myled1(LED1); +DigitalOut myled2(LED2); +CameraC328 camera(p9, p10, CameraC328::Baud57600); +Serial serial(USBTX, USBRX); +LocalFileSystem fs ("fs"); +const int IMG_X = 80; +const int IMG_Y = 60; +char buf[IMG_X * IMG_Y * 2]; + +void cbfunc(size_t done, size_t total, char c) { + buf[done - 1] = c; +} + +void sync(void) { + CameraC328::ErrorNumber err = CameraC328::NoError; + + err = camera.sync(); + if (CameraC328::NoError == err) { + serial.printf("[ OK ] : CameraC328::sync\n"); + } else { + serial.printf("[FAIL] : CameraC328::sync (Error=%02X)\n", (int)err); + } +} + +void test_uncompressed_snapshot_picture(void) { + CameraC328::ErrorNumber err = CameraC328::NoError; + + err = camera.init(CameraC328::Color16bit, CameraC328::RawResolution80x60, CameraC328::JpegResolution80x64); + if (CameraC328::NoError == err) { + serial.printf("[ OK ] : CameraC328::init\n"); + } else { + serial.printf("[FAIL] : CameraC328::init (Error=%02X)\n", (int)err); + } + + for (int i = 0; i < 10; i++) { + err = camera.getUncompressedSnapshotPicture(cbfunc); + if (CameraC328::NoError == err) { + serial.printf("[ OK ] : CameraC328::getUncompressedSnapshotPicture\n"); + } else { + serial.printf("[FAIL] : CameraC328::getUncompressedSnapshotPicture (Error=%02X)\n", (int)err); + } + + char fname[64]; + snprintf(fname, sizeof(fname), "/fs/ucss%04d.ppm", i); + FILE *fp = fopen(fname, "w"); + fprintf(fp, "P3\n"); + fprintf(fp, "%d %d\n", IMG_X, IMG_Y); + fprintf(fp, "%d\n", 255); + for (int y = 0; y < IMG_Y; y++) { + for (int x = 0; x < IMG_X; x++) { + int adrofs = y * (IMG_X * 2) + (x * 2); + uint16_t dat = (buf[adrofs + 0] << 8) | (buf[adrofs + 1] << 0); + uint8_t r = ((dat >> 11) & 0x1f) << 3; + uint8_t g = ((dat >> 5) & 0x3f) << 2; + uint8_t b = ((dat >> 0) & 0x1f) << 3; + fprintf(fp,"%d %d %d\n", r, g, b); + } + } + fclose(fp); + } +} + +void test_uncompressed_preview_picture(void) { + CameraC328::ErrorNumber err = CameraC328::NoError; + + err = camera.init(CameraC328::Color16bit, CameraC328::RawResolution80x60, CameraC328::JpegResolution80x64); + if (CameraC328::NoError == err) { + serial.printf("[ OK ] : CameraC328::init\n"); + } else { + serial.printf("[FAIL] : CameraC328::init (Error=%02X)\n", (int)err); + } + + for (int i = 0; i < 10; i++) { + err = camera.getUncompressedPreviewPicture(cbfunc); + if (CameraC328::NoError == err) { + serial.printf("[ OK ] : CameraC328::getUncompressedPreviewPicture\n"); + } else { + serial.printf("[FAIL] : CameraC328::getUncompressedPreviewPicture (Error=%02X)\n", (int)err); + } + + char fname[64]; + snprintf(fname, sizeof(fname), "/fs/ucpv%04d.ppm", i); + FILE *fp = fopen(fname, "w"); + fprintf(fp, "P3\n"); + fprintf(fp, "%d %d\n", IMG_X, IMG_Y); + fprintf(fp, "%d\n", 255); + for (int y = 0; y < IMG_Y; y++) { + for (int x = 0; x < IMG_X; x++) { + int adrofs = y * (IMG_X * 2) + (x * 2); + uint16_t dat = (buf[adrofs + 0] << 8) | (buf[adrofs + 1] << 0); + uint8_t r = ((dat >> 11) & 0x1f) << 3; + uint8_t g = ((dat >> 5) & 0x3f) << 2; + uint8_t b = ((dat >> 0) & 0x1f) << 3; + fprintf(fp,"%d %d %d\n", r, g, b); + } + } + fclose(fp); + } +} + +int main() { + serial.baud(19200); + serial.printf("\n"); + serial.printf("==========\n"); + serial.printf("CameraC328\n"); + serial.printf("==========\n"); + + sync(); + test_uncompressed_snapshot_picture(); + test_uncompressed_preview_picture(); + + while (1) { + myled1 = 1; + wait(0.2); + myled1 = 0; + wait(0.2); + myled2 = 1; + wait(0.2); + myled2 = 0; + wait(0.2); + } +}