HEPTA-Sat Hands－On / Mbed 2 deprecated HeptaXbee_Uplink

Xbee Uplink

Dependencies:   mbed PowerControl SDFileSystem

Fork of HeptaXbee_Uplink by 智也 大野

hepta_sat/HeptaCamera.cpp@3:15a7f7fa174a, 2016-12-14 (annotated)

Committer:
MEXT1
Date:
Wed Dec 14 16:09:56 2016 +0000
Revision:
3:15a7f7fa174a
Parent:
0:9a52d95a79f7 
Xbee Uplink

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tomoya123 0:9a52d95a79f7 1 #include "HeptaCamera.h"
tomoya123 0:9a52d95a79f7 2 #include "mbed.h"
tomoya123 0:9a52d95a79f7 3
tomoya123 0:9a52d95a79f7 4 int sizex = 0;
tomoya123 0:9a52d95a79f7 5 int sizey = 0;
tomoya123 0:9a52d95a79f7 6
tomoya123 0:9a52d95a79f7 7 #if defined(BITMAPFILE) || defined(BAYERBITMAPFILE)
tomoya123 0:9a52d95a79f7 8
tomoya123 0:9a52d95a79f7 9 #define FILEHEADERSIZE 14 //ファイルヘッダのサイズ
tomoya123 0:9a52d95a79f7 10 #define INFOHEADERSIZE 40 //情報ヘッダのサイズ
tomoya123 0:9a52d95a79f7 11 #define HEADERSIZE (FILEHEADERSIZE+INFOHEADERSIZE)
tomoya123 0:9a52d95a79f7 12
tomoya123 0:9a52d95a79f7 13 int create_header(FILE *fp, int width, int height) {
tomoya123 0:9a52d95a79f7 14 int real_width;
tomoya123 0:9a52d95a79f7 15 unsigned char header_buf[HEADERSIZE]; //ヘッダを格納する
tomoya123 0:9a52d95a79f7 16 unsigned int file_size;
tomoya123 0:9a52d95a79f7 17 unsigned int offset_to_data;
tomoya123 0:9a52d95a79f7 18 unsigned long info_header_size;
tomoya123 0:9a52d95a79f7 19 unsigned int planes;
tomoya123 0:9a52d95a79f7 20 unsigned int color;
tomoya123 0:9a52d95a79f7 21 unsigned long compress;
tomoya123 0:9a52d95a79f7 22 unsigned long data_size;
tomoya123 0:9a52d95a79f7 23 long xppm;
tomoya123 0:9a52d95a79f7 24 long yppm;
tomoya123 0:9a52d95a79f7 25
tomoya123 0:9a52d95a79f7 26 real_width = width*3 + width%4;
tomoya123 0:9a52d95a79f7 27
tomoya123 0:9a52d95a79f7 28 //ここからヘッダ作成
tomoya123 0:9a52d95a79f7 29 file_size = height * real_width + HEADERSIZE;
tomoya123 0:9a52d95a79f7 30 offset_to_data = HEADERSIZE;
tomoya123 0:9a52d95a79f7 31 info_header_size = INFOHEADERSIZE;
tomoya123 0:9a52d95a79f7 32 planes = 1;
tomoya123 0:9a52d95a79f7 33 color = 24;
tomoya123 0:9a52d95a79f7 34 compress = 0;
tomoya123 0:9a52d95a79f7 35 data_size = height * real_width;
tomoya123 0:9a52d95a79f7 36 xppm = 1;
tomoya123 0:9a52d95a79f7 37 yppm = 1;
tomoya123 0:9a52d95a79f7 38
tomoya123 0:9a52d95a79f7 39 header_buf[0] = 'B';
tomoya123 0:9a52d95a79f7 40 header_buf[1] = 'M';
tomoya123 0:9a52d95a79f7 41 memcpy(header_buf + 2, &file_size, sizeof(file_size));
tomoya123 0:9a52d95a79f7 42 header_buf[6] = 0;
tomoya123 0:9a52d95a79f7 43 header_buf[7] = 0;
tomoya123 0:9a52d95a79f7 44 header_buf[8] = 0;
tomoya123 0:9a52d95a79f7 45 header_buf[9] = 0;
tomoya123 0:9a52d95a79f7 46 memcpy(header_buf + 10, &offset_to_data, sizeof(offset_to_data));
tomoya123 0:9a52d95a79f7 47 memcpy(header_buf + 14, &info_header_size, sizeof(info_header_size));
tomoya123 0:9a52d95a79f7 48 memcpy(header_buf + 18, &width, sizeof(width));
tomoya123 0:9a52d95a79f7 49 height = height * -1; // データ格納順が逆なので、高さをマイナスとしている
tomoya123 0:9a52d95a79f7 50 memcpy(header_buf + 22, &height, sizeof(height));
tomoya123 0:9a52d95a79f7 51 memcpy(header_buf + 26, &planes, sizeof(planes));
tomoya123 0:9a52d95a79f7 52 memcpy(header_buf + 28, &color, sizeof(color));
tomoya123 0:9a52d95a79f7 53 memcpy(header_buf + 30, &compress, sizeof(compress));
tomoya123 0:9a52d95a79f7 54 memcpy(header_buf + 34, &data_size, sizeof(data_size));
tomoya123 0:9a52d95a79f7 55 memcpy(header_buf + 38, &xppm, sizeof(xppm));
tomoya123 0:9a52d95a79f7 56 memcpy(header_buf + 42, &yppm, sizeof(yppm));
tomoya123 0:9a52d95a79f7 57 header_buf[46] = 0;
tomoya123 0:9a52d95a79f7 58 header_buf[47] = 0;
tomoya123 0:9a52d95a79f7 59 header_buf[48] = 0;
tomoya123 0:9a52d95a79f7 60 header_buf[49] = 0;
tomoya123 0:9a52d95a79f7 61 header_buf[50] = 0;
tomoya123 0:9a52d95a79f7 62 header_buf[51] = 0;
tomoya123 0:9a52d95a79f7 63 header_buf[52] = 0;
tomoya123 0:9a52d95a79f7 64 header_buf[53] = 0;
tomoya123 0:9a52d95a79f7 65
tomoya123 0:9a52d95a79f7 66 //ヘッダの書き込み
tomoya123 0:9a52d95a79f7 67 fwrite(header_buf, sizeof(unsigned char), HEADERSIZE, fp);
tomoya123 0:9a52d95a79f7 68
tomoya123 0:9a52d95a79f7 69 return 0;
tomoya123 0:9a52d95a79f7 70 }
tomoya123 0:9a52d95a79f7 71 #endif
tomoya123 0:9a52d95a79f7 72
tomoya123 0:9a52d95a79f7 73 HeptaCamera::HeptaCamera(PinName sda, PinName scl, PinName vs, PinName hr,PinName we, PinName d7, PinName d6, PinName d5, PinName d4,
tomoya123 0:9a52d95a79f7 74 PinName d3, PinName d2, PinName d1, PinName d0, PinName rt, PinName o, PinName rc ) : camera(sda,scl),vsync(vs),href(hr),wen(we),data(d0,d1,d2,d3,d4,d5,d6,d7),rrst(rt),oe(o),rclk(rc)
tomoya123 0:9a52d95a79f7 75 {
tomoya123 0:9a52d95a79f7 76 camera.stop();
tomoya123 0:9a52d95a79f7 77 camera.frequency(OV7670_I2CFREQ);
tomoya123 0:9a52d95a79f7 78 vsync.fall(this,&HeptaCamera::VsyncHandler);
tomoya123 0:9a52d95a79f7 79 href.rise(this,&HeptaCamera::HrefHandler);
tomoya123 0:9a52d95a79f7 80 CaptureReq = false;
tomoya123 0:9a52d95a79f7 81 Busy = false;
tomoya123 0:9a52d95a79f7 82 Done = false;
tomoya123 0:9a52d95a79f7 83 LineCounter = 0;
tomoya123 0:9a52d95a79f7 84 rrst = 1;
tomoya123 0:9a52d95a79f7 85 oe = 1;
tomoya123 0:9a52d95a79f7 86 rclk = 1;
tomoya123 0:9a52d95a79f7 87 wen = 0;
tomoya123 0:9a52d95a79f7 88 }
tomoya123 0:9a52d95a79f7 89 // capture request
tomoya123 0:9a52d95a79f7 90 void HeptaCamera::CaptureNext(void)
tomoya123 0:9a52d95a79f7 91 {
tomoya123 0:9a52d95a79f7 92 CaptureReq = true;
tomoya123 0:9a52d95a79f7 93 Busy = true;
tomoya123 0:9a52d95a79f7 94 }
tomoya123 0:9a52d95a79f7 95
tomoya123 0:9a52d95a79f7 96 // capture done? (with clear)
tomoya123 0:9a52d95a79f7 97 bool HeptaCamera::CaptureDone(void)
tomoya123 0:9a52d95a79f7 98 {
tomoya123 0:9a52d95a79f7 99 bool result;
tomoya123 0:9a52d95a79f7 100 if (Busy) {
tomoya123 0:9a52d95a79f7 101 result = false;
tomoya123 0:9a52d95a79f7 102 } else {
tomoya123 0:9a52d95a79f7 103 result = Done;
tomoya123 0:9a52d95a79f7 104 Done = false;
tomoya123 0:9a52d95a79f7 105 }
tomoya123 0:9a52d95a79f7 106 return result;
tomoya123 0:9a52d95a79f7 107 }
tomoya123 0:9a52d95a79f7 108
tomoya123 0:9a52d95a79f7 109 // write to camera
tomoya123 0:9a52d95a79f7 110 void HeptaCamera::WriteReg(int addr,int data)
tomoya123 0:9a52d95a79f7 111 {
tomoya123 0:9a52d95a79f7 112 // WRITE 0x42,ADDR,DATA
tomoya123 0:9a52d95a79f7 113 camera.start();
tomoya123 0:9a52d95a79f7 114 camera.write(OV7670_WRITE);
tomoya123 0:9a52d95a79f7 115 wait_us(OV7670_WRITEWAIT);
tomoya123 0:9a52d95a79f7 116 camera.write(addr);
tomoya123 0:9a52d95a79f7 117 wait_us(OV7670_WRITEWAIT);
tomoya123 0:9a52d95a79f7 118 camera.write(data);
tomoya123 0:9a52d95a79f7 119 camera.stop();
tomoya123 0:9a52d95a79f7 120 }
tomoya123 0:9a52d95a79f7 121
tomoya123 0:9a52d95a79f7 122 // read from camera
tomoya123 0:9a52d95a79f7 123 int HeptaCamera::ReadReg(int addr)
tomoya123 0:9a52d95a79f7 124 {
tomoya123 0:9a52d95a79f7 125 int data;
tomoya123 0:9a52d95a79f7 126
tomoya123 0:9a52d95a79f7 127 // WRITE 0x42,ADDR
tomoya123 0:9a52d95a79f7 128 camera.start();
tomoya123 0:9a52d95a79f7 129 camera.write(OV7670_WRITE);
tomoya123 0:9a52d95a79f7 130 wait_us(OV7670_WRITEWAIT);
tomoya123 0:9a52d95a79f7 131 camera.write(addr);
tomoya123 0:9a52d95a79f7 132 camera.stop();
tomoya123 0:9a52d95a79f7 133 wait_us(OV7670_WRITEWAIT);
tomoya123 0:9a52d95a79f7 134
tomoya123 0:9a52d95a79f7 135 // WRITE 0x43,READ
tomoya123 0:9a52d95a79f7 136 camera.start();
tomoya123 0:9a52d95a79f7 137 camera.write(OV7670_READ);
tomoya123 0:9a52d95a79f7 138 wait_us(OV7670_WRITEWAIT);
tomoya123 0:9a52d95a79f7 139 data = camera.read(OV7670_NOACK);
tomoya123 0:9a52d95a79f7 140 camera.stop();
tomoya123 0:9a52d95a79f7 141
tomoya123 0:9a52d95a79f7 142 return data;
tomoya123 0:9a52d95a79f7 143 }
tomoya123 0:9a52d95a79f7 144
tomoya123 0:9a52d95a79f7 145 // print register
tomoya123 0:9a52d95a79f7 146 void HeptaCamera::PrintRegister(void) {
tomoya123 0:9a52d95a79f7 147 printf("AD : +0 +1 +2 +3 +4 +5 +6 +7 +8 +9 +A +B +C +D +E +F");
tomoya123 0:9a52d95a79f7 148 for (int i=0;i<OV7670_REGMAX;i++) {
tomoya123 0:9a52d95a79f7 149 int data;
tomoya123 0:9a52d95a79f7 150 data = ReadReg(i); // READ REG
tomoya123 0:9a52d95a79f7 151 if ((i & 0x0F) == 0) {
tomoya123 0:9a52d95a79f7 152 printf("\r\n%02X : ",i);
tomoya123 0:9a52d95a79f7 153 }
tomoya123 0:9a52d95a79f7 154 printf("%02X ",data);
tomoya123 0:9a52d95a79f7 155 }
tomoya123 0:9a52d95a79f7 156 printf("\r\n");
tomoya123 0:9a52d95a79f7 157 }
tomoya123 0:9a52d95a79f7 158
tomoya123 0:9a52d95a79f7 159 void HeptaCamera::Reset(void) {
tomoya123 0:9a52d95a79f7 160 WriteReg(REG_COM7,COM7_RESET); // RESET CAMERA
tomoya123 0:9a52d95a79f7 161 wait_ms(200);
tomoya123 0:9a52d95a79f7 162 }
tomoya123 0:9a52d95a79f7 163
tomoya123 0:9a52d95a79f7 164 void HeptaCamera::InitForFIFOWriteReset(void) {
tomoya123 0:9a52d95a79f7 165 WriteReg(REG_COM10, COM10_VS_NEG);
tomoya123 0:9a52d95a79f7 166 }
tomoya123 0:9a52d95a79f7 167
tomoya123 0:9a52d95a79f7 168 void HeptaCamera::InitSetColorbar(void) {
tomoya123 0:9a52d95a79f7 169 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 170 // color bar
tomoya123 0:9a52d95a79f7 171 WriteReg(REG_COM17, reg_com7|COM17_CBAR);
tomoya123 0:9a52d95a79f7 172 }
tomoya123 0:9a52d95a79f7 173
tomoya123 0:9a52d95a79f7 174 void HeptaCamera::InitDefaultReg(void) {
tomoya123 0:9a52d95a79f7 175 // Gamma curve values
tomoya123 0:9a52d95a79f7 176 WriteReg(0x7a, 0x20);
tomoya123 0:9a52d95a79f7 177 WriteReg(0x7b, 0x10);
tomoya123 0:9a52d95a79f7 178 WriteReg(0x7c, 0x1e);
tomoya123 0:9a52d95a79f7 179 WriteReg(0x7d, 0x35);
tomoya123 0:9a52d95a79f7 180 WriteReg(0x7e, 0x5a);
tomoya123 0:9a52d95a79f7 181 WriteReg(0x7f, 0x69);
tomoya123 0:9a52d95a79f7 182 WriteReg(0x80, 0x76);
tomoya123 0:9a52d95a79f7 183 WriteReg(0x81, 0x80);
tomoya123 0:9a52d95a79f7 184 WriteReg(0x82, 0x88);
tomoya123 0:9a52d95a79f7 185 WriteReg(0x83, 0x8f);
tomoya123 0:9a52d95a79f7 186 WriteReg(0x84, 0x96);
tomoya123 0:9a52d95a79f7 187 WriteReg(0x85, 0xa3);
tomoya123 0:9a52d95a79f7 188 WriteReg(0x86, 0xaf);
tomoya123 0:9a52d95a79f7 189 WriteReg(0x87, 0xc4);
tomoya123 0:9a52d95a79f7 190 WriteReg(0x88, 0xd7);
tomoya123 0:9a52d95a79f7 191 WriteReg(0x89, 0xe8);
tomoya123 0:9a52d95a79f7 192
tomoya123 0:9a52d95a79f7 193 // AGC and AEC parameters. Note we start by disabling those features,
tomoya123 0:9a52d95a79f7 194 //then turn them only after tweaking the values.
tomoya123 0:9a52d95a79f7 195 WriteReg(REG_COM8, COM8_FASTAEC | COM8_AECSTEP | COM8_BFILT);
tomoya123 0:9a52d95a79f7 196 WriteReg(REG_GAIN, 0);
tomoya123 0:9a52d95a79f7 197 WriteReg(REG_AECH, 0);
tomoya123 0:9a52d95a79f7 198 WriteReg(REG_COM4, 0x40);
tomoya123 0:9a52d95a79f7 199 // magic reserved bit
tomoya123 0:9a52d95a79f7 200 WriteReg(REG_COM9, 0x18);
tomoya123 0:9a52d95a79f7 201 // 4x gain + magic rsvd bit
tomoya123 0:9a52d95a79f7 202 WriteReg(REG_BD50MAX, 0x05);
tomoya123 0:9a52d95a79f7 203 WriteReg(REG_BD60MAX, 0x07);
tomoya123 0:9a52d95a79f7 204 WriteReg(REG_AEW, 0x95);
tomoya123 0:9a52d95a79f7 205 WriteReg(REG_AEB, 0x33);
tomoya123 0:9a52d95a79f7 206 WriteReg(REG_VPT, 0xe3);
tomoya123 0:9a52d95a79f7 207 WriteReg(REG_HAECC1, 0x78);
tomoya123 0:9a52d95a79f7 208 WriteReg(REG_HAECC2, 0x68);
tomoya123 0:9a52d95a79f7 209 WriteReg(0xa1, 0x03);
tomoya123 0:9a52d95a79f7 210 // magic
tomoya123 0:9a52d95a79f7 211 WriteReg(REG_HAECC3, 0xd8);
tomoya123 0:9a52d95a79f7 212 WriteReg(REG_HAECC4, 0xd8);
tomoya123 0:9a52d95a79f7 213 WriteReg(REG_HAECC5, 0xf0);
tomoya123 0:9a52d95a79f7 214 WriteReg(REG_HAECC6, 0x90);
tomoya123 0:9a52d95a79f7 215 WriteReg(REG_HAECC7, 0x94);
tomoya123 0:9a52d95a79f7 216 WriteReg(REG_COM8, COM8_FASTAEC|COM8_AECSTEP|COM8_BFILT|COM8_AGC|COM8_AEC);
tomoya123 0:9a52d95a79f7 217
tomoya123 0:9a52d95a79f7 218 // Almost all of these are magic "reserved" values.
tomoya123 0:9a52d95a79f7 219 WriteReg(REG_COM5, 0x61);
tomoya123 0:9a52d95a79f7 220 WriteReg(REG_COM6, 0x4b);
tomoya123 0:9a52d95a79f7 221 WriteReg(0x16, 0x02);
tomoya123 0:9a52d95a79f7 222 WriteReg(REG_MVFP, 0x07);
tomoya123 0:9a52d95a79f7 223 WriteReg(0x21, 0x02);
tomoya123 0:9a52d95a79f7 224 WriteReg(0x22, 0x91);
tomoya123 0:9a52d95a79f7 225 WriteReg(0x29, 0x07);
tomoya123 0:9a52d95a79f7 226 WriteReg(0x33, 0x0b);
tomoya123 0:9a52d95a79f7 227 WriteReg(0x35, 0x0b);
tomoya123 0:9a52d95a79f7 228 WriteReg(0x37, 0x1d);
tomoya123 0:9a52d95a79f7 229 WriteReg(0x38, 0x71);
tomoya123 0:9a52d95a79f7 230 WriteReg(0x39, 0x2a);
tomoya123 0:9a52d95a79f7 231 WriteReg(REG_COM12, 0x78);
tomoya123 0:9a52d95a79f7 232 WriteReg(0x4d, 0x40);
tomoya123 0:9a52d95a79f7 233 WriteReg(0x4e, 0x20);
tomoya123 0:9a52d95a79f7 234 WriteReg(REG_GFIX, 0);
tomoya123 0:9a52d95a79f7 235 WriteReg(0x6b, 0x0a);
tomoya123 0:9a52d95a79f7 236 WriteReg(0x74, 0x10);
tomoya123 0:9a52d95a79f7 237 WriteReg(0x8d, 0x4f);
tomoya123 0:9a52d95a79f7 238 WriteReg(0x8e, 0);
tomoya123 0:9a52d95a79f7 239 WriteReg(0x8f, 0);
tomoya123 0:9a52d95a79f7 240 WriteReg(0x90, 0);
tomoya123 0:9a52d95a79f7 241 WriteReg(0x91, 0);
tomoya123 0:9a52d95a79f7 242 WriteReg(0x96, 0);
tomoya123 0:9a52d95a79f7 243 WriteReg(0x9a, 0);
tomoya123 0:9a52d95a79f7 244 WriteReg(0xb0, 0x84);
tomoya123 0:9a52d95a79f7 245 WriteReg(0xb1, 0x0c);
tomoya123 0:9a52d95a79f7 246 WriteReg(0xb2, 0x0e);
tomoya123 0:9a52d95a79f7 247 WriteReg(0xb3, 0x82);
tomoya123 0:9a52d95a79f7 248 WriteReg(0xb8, 0x0a);
tomoya123 0:9a52d95a79f7 249
tomoya123 0:9a52d95a79f7 250 // More reserved magic, some of which tweaks white balance
tomoya123 0:9a52d95a79f7 251 WriteReg(0x43, 0x0a);
tomoya123 0:9a52d95a79f7 252 WriteReg(0x44, 0xf0);
tomoya123 0:9a52d95a79f7 253 WriteReg(0x45, 0x34);
tomoya123 0:9a52d95a79f7 254 WriteReg(0x46, 0x58);
tomoya123 0:9a52d95a79f7 255 WriteReg(0x47, 0x28);
tomoya123 0:9a52d95a79f7 256 WriteReg(0x48, 0x3a);
tomoya123 0:9a52d95a79f7 257 WriteReg(0x59, 0x88);
tomoya123 0:9a52d95a79f7 258 WriteReg(0x5a, 0x88);
tomoya123 0:9a52d95a79f7 259 WriteReg(0x5b, 0x44);
tomoya123 0:9a52d95a79f7 260 WriteReg(0x5c, 0x67);
tomoya123 0:9a52d95a79f7 261 WriteReg(0x5d, 0x49);
tomoya123 0:9a52d95a79f7 262 WriteReg(0x5e, 0x0e);
tomoya123 0:9a52d95a79f7 263 WriteReg(0x6c, 0x0a);
tomoya123 0:9a52d95a79f7 264 WriteReg(0x6d, 0x55);
tomoya123 0:9a52d95a79f7 265 WriteReg(0x6e, 0x11);
tomoya123 0:9a52d95a79f7 266 WriteReg(0x6f, 0x9f);
tomoya123 0:9a52d95a79f7 267 // "9e for advance AWB"
tomoya123 0:9a52d95a79f7 268 WriteReg(0x6a, 0x40);
tomoya123 0:9a52d95a79f7 269 WriteReg(REG_BLUE, 0x40);
tomoya123 0:9a52d95a79f7 270 WriteReg(REG_RED, 0x60);
tomoya123 0:9a52d95a79f7 271 WriteReg(REG_COM8, COM8_FASTAEC|COM8_AECSTEP|COM8_BFILT|COM8_AGC|COM8_AEC|COM8_AWB);
tomoya123 0:9a52d95a79f7 272
tomoya123 0:9a52d95a79f7 273 // Matrix coefficients
tomoya123 0:9a52d95a79f7 274 WriteReg(0x4f, 0x80);
tomoya123 0:9a52d95a79f7 275 WriteReg(0x50, 0x80);
tomoya123 0:9a52d95a79f7 276 WriteReg(0x51, 0);
tomoya123 0:9a52d95a79f7 277 WriteReg(0x52, 0x22);
tomoya123 0:9a52d95a79f7 278 WriteReg(0x53, 0x5e);
tomoya123 0:9a52d95a79f7 279 WriteReg(0x54, 0x80);
tomoya123 0:9a52d95a79f7 280 WriteReg(0x58, 0x9e);
tomoya123 0:9a52d95a79f7 281
tomoya123 0:9a52d95a79f7 282 WriteReg(REG_COM16, COM16_AWBGAIN);
tomoya123 0:9a52d95a79f7 283 WriteReg(REG_EDGE, 0);
tomoya123 0:9a52d95a79f7 284 WriteReg(0x75, 0x05);
tomoya123 0:9a52d95a79f7 285 WriteReg(0x76, 0xe1);
tomoya123 0:9a52d95a79f7 286 WriteReg(0x4c, 0);
tomoya123 0:9a52d95a79f7 287 WriteReg(0x77, 0x01);
tomoya123 0:9a52d95a79f7 288 WriteReg(0x4b, 0x09);
tomoya123 0:9a52d95a79f7 289 WriteReg(0xc9, 0x60);
tomoya123 0:9a52d95a79f7 290 WriteReg(REG_COM16, 0x38);
tomoya123 0:9a52d95a79f7 291 WriteReg(0x56, 0x40);
tomoya123 0:9a52d95a79f7 292
tomoya123 0:9a52d95a79f7 293 WriteReg(0x34, 0x11);
tomoya123 0:9a52d95a79f7 294 WriteReg(REG_COM11, COM11_EXP|COM11_HZAUTO_ON);
tomoya123 0:9a52d95a79f7 295 WriteReg(0xa4, 0x88);
tomoya123 0:9a52d95a79f7 296 WriteReg(0x96, 0);
tomoya123 0:9a52d95a79f7 297 WriteReg(0x97, 0x30);
tomoya123 0:9a52d95a79f7 298 WriteReg(0x98, 0x20);
tomoya123 0:9a52d95a79f7 299 WriteReg(0x99, 0x30);
tomoya123 0:9a52d95a79f7 300 WriteReg(0x9a, 0x84);
tomoya123 0:9a52d95a79f7 301 WriteReg(0x9b, 0x29);
tomoya123 0:9a52d95a79f7 302 WriteReg(0x9c, 0x03);
tomoya123 0:9a52d95a79f7 303 WriteReg(0x9d, 0x4c);
tomoya123 0:9a52d95a79f7 304 WriteReg(0x9e, 0x3f);
tomoya123 0:9a52d95a79f7 305 WriteReg(0x78, 0x04);
tomoya123 0:9a52d95a79f7 306
tomoya123 0:9a52d95a79f7 307 // Extra-weird stuff. Some sort of multiplexor register
tomoya123 0:9a52d95a79f7 308 WriteReg(0x79, 0x01);
tomoya123 0:9a52d95a79f7 309 WriteReg(0xc8, 0xf0);
tomoya123 0:9a52d95a79f7 310 WriteReg(0x79, 0x0f);
tomoya123 0:9a52d95a79f7 311 WriteReg(0xc8, 0x00);
tomoya123 0:9a52d95a79f7 312 WriteReg(0x79, 0x10);
tomoya123 0:9a52d95a79f7 313 WriteReg(0xc8, 0x7e);
tomoya123 0:9a52d95a79f7 314 WriteReg(0x79, 0x0a);
tomoya123 0:9a52d95a79f7 315 WriteReg(0xc8, 0x80);
tomoya123 0:9a52d95a79f7 316 WriteReg(0x79, 0x0b);
tomoya123 0:9a52d95a79f7 317 WriteReg(0xc8, 0x01);
tomoya123 0:9a52d95a79f7 318 WriteReg(0x79, 0x0c);
tomoya123 0:9a52d95a79f7 319 WriteReg(0xc8, 0x0f);
tomoya123 0:9a52d95a79f7 320 WriteReg(0x79, 0x0d);
tomoya123 0:9a52d95a79f7 321 WriteReg(0xc8, 0x20);
tomoya123 0:9a52d95a79f7 322 WriteReg(0x79, 0x09);
tomoya123 0:9a52d95a79f7 323 WriteReg(0xc8, 0x80);
tomoya123 0:9a52d95a79f7 324 WriteReg(0x79, 0x02);
tomoya123 0:9a52d95a79f7 325 WriteReg(0xc8, 0xc0);
tomoya123 0:9a52d95a79f7 326 WriteReg(0x79, 0x03);
tomoya123 0:9a52d95a79f7 327 WriteReg(0xc8, 0x40);
tomoya123 0:9a52d95a79f7 328 WriteReg(0x79, 0x05);
tomoya123 0:9a52d95a79f7 329 WriteReg(0xc8, 0x30);
tomoya123 0:9a52d95a79f7 330 WriteReg(0x79, 0x26);
tomoya123 0:9a52d95a79f7 331 }
tomoya123 0:9a52d95a79f7 332
tomoya123 0:9a52d95a79f7 333 void HeptaCamera::InitRGB444(void){
tomoya123 0:9a52d95a79f7 334 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 335
tomoya123 0:9a52d95a79f7 336 WriteReg(REG_COM7, reg_com7|COM7_RGB);
tomoya123 0:9a52d95a79f7 337 WriteReg(REG_RGB444, RGB444_ENABLE|RGB444_XBGR);
tomoya123 0:9a52d95a79f7 338 WriteReg(REG_COM15, COM15_R01FE|COM15_RGB444);
tomoya123 0:9a52d95a79f7 339
tomoya123 0:9a52d95a79f7 340 WriteReg(REG_COM1, 0x40); // Magic reserved bit
tomoya123 0:9a52d95a79f7 341 WriteReg(REG_COM9, 0x38); // 16x gain ceiling; 0x8 is reserved bit
tomoya123 0:9a52d95a79f7 342 WriteReg(0x4f, 0xb3); // "matrix coefficient 1"
tomoya123 0:9a52d95a79f7 343 WriteReg(0x50, 0xb3); // "matrix coefficient 2"
tomoya123 0:9a52d95a79f7 344 WriteReg(0x51, 0x00); // vb
tomoya123 0:9a52d95a79f7 345 WriteReg(0x52, 0x3d); // "matrix coefficient 4"
tomoya123 0:9a52d95a79f7 346 WriteReg(0x53, 0xa7); // "matrix coefficient 5"
tomoya123 0:9a52d95a79f7 347 WriteReg(0x54, 0xe4); // "matrix coefficient 6"
tomoya123 0:9a52d95a79f7 348 WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT|0x2); // Magic rsvd bit
tomoya123 0:9a52d95a79f7 349
tomoya123 0:9a52d95a79f7 350 WriteReg(REG_TSLB, 0x04);
tomoya123 0:9a52d95a79f7 351 }
tomoya123 0:9a52d95a79f7 352
tomoya123 0:9a52d95a79f7 353 void HeptaCamera::InitRGB555(void){
tomoya123 0:9a52d95a79f7 354 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 355
tomoya123 0:9a52d95a79f7 356 WriteReg(REG_COM7, reg_com7|COM7_RGB);
tomoya123 0:9a52d95a79f7 357 WriteReg(REG_RGB444, RGB444_DISABLE);
tomoya123 0:9a52d95a79f7 358 WriteReg(REG_COM15, COM15_RGB555|COM15_R00FF);
tomoya123 0:9a52d95a79f7 359
tomoya123 0:9a52d95a79f7 360 WriteReg(REG_TSLB, 0x04);
tomoya123 0:9a52d95a79f7 361
tomoya123 0:9a52d95a79f7 362 WriteReg(REG_COM1, 0x00);
tomoya123 0:9a52d95a79f7 363 WriteReg(REG_COM9, 0x38); // 16x gain ceiling; 0x8 is reserved bit
tomoya123 0:9a52d95a79f7 364 WriteReg(0x4f, 0xb3); // "matrix coefficient 1"
tomoya123 0:9a52d95a79f7 365 WriteReg(0x50, 0xb3); // "matrix coefficient 2"
tomoya123 0:9a52d95a79f7 366 WriteReg(0x51, 0x00); // vb
tomoya123 0:9a52d95a79f7 367 WriteReg(0x52, 0x3d); // "matrix coefficient 4"
tomoya123 0:9a52d95a79f7 368 WriteReg(0x53, 0xa7); // "matrix coefficient 5"
tomoya123 0:9a52d95a79f7 369 WriteReg(0x54, 0xe4); // "matrix coefficient 6"
tomoya123 0:9a52d95a79f7 370 WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT);
tomoya123 0:9a52d95a79f7 371 }
tomoya123 0:9a52d95a79f7 372
tomoya123 0:9a52d95a79f7 373 void HeptaCamera::InitRGB565(void){
tomoya123 0:9a52d95a79f7 374 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 375
tomoya123 0:9a52d95a79f7 376 WriteReg(REG_COM7, reg_com7|COM7_RGB);
tomoya123 0:9a52d95a79f7 377 WriteReg(REG_RGB444, RGB444_DISABLE);
tomoya123 0:9a52d95a79f7 378 WriteReg(REG_COM15, COM15_R00FF|COM15_RGB565);
tomoya123 0:9a52d95a79f7 379
tomoya123 0:9a52d95a79f7 380 WriteReg(REG_TSLB, 0x04);
tomoya123 0:9a52d95a79f7 381
tomoya123 0:9a52d95a79f7 382 WriteReg(REG_COM1, 0x00);
tomoya123 0:9a52d95a79f7 383 WriteReg(REG_COM9, 0x38); // 16x gain ceiling; 0x8 is reserved bit
tomoya123 0:9a52d95a79f7 384 WriteReg(0x4f, 0xb3); // "matrix coefficient 1"
tomoya123 0:9a52d95a79f7 385 WriteReg(0x50, 0xb3); // "matrix coefficient 2"
tomoya123 0:9a52d95a79f7 386 WriteReg(0x51, 0x00); // vb
tomoya123 0:9a52d95a79f7 387 WriteReg(0x52, 0x3d); // "matrix coefficient 4"
tomoya123 0:9a52d95a79f7 388 WriteReg(0x53, 0xa7); // "matrix coefficient 5"
tomoya123 0:9a52d95a79f7 389 WriteReg(0x54, 0xe4); // "matrix coefficient 6"
tomoya123 0:9a52d95a79f7 390 WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT);
tomoya123 0:9a52d95a79f7 391 }
tomoya123 0:9a52d95a79f7 392
tomoya123 0:9a52d95a79f7 393 void HeptaCamera::InitYUV(void){
tomoya123 0:9a52d95a79f7 394 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 395
tomoya123 0:9a52d95a79f7 396 WriteReg(REG_COM7, reg_com7|COM7_YUV);
tomoya123 0:9a52d95a79f7 397 WriteReg(REG_RGB444, RGB444_DISABLE);
tomoya123 0:9a52d95a79f7 398 WriteReg(REG_COM15, COM15_R00FF);
tomoya123 0:9a52d95a79f7 399
tomoya123 0:9a52d95a79f7 400 WriteReg(REG_TSLB, 0x04);
tomoya123 0:9a52d95a79f7 401 // WriteReg(REG_TSLB, 0x14);
tomoya123 0:9a52d95a79f7 402 // WriteReg(REG_MANU, 0x00);
tomoya123 0:9a52d95a79f7 403 // WriteReg(REG_MANV, 0x00);
tomoya123 0:9a52d95a79f7 404
tomoya123 0:9a52d95a79f7 405 WriteReg(REG_COM1, 0x00);
tomoya123 0:9a52d95a79f7 406 WriteReg(REG_COM9, 0x18); // 4x gain ceiling; 0x8 is reserved bit
tomoya123 0:9a52d95a79f7 407 WriteReg(0x4f, 0x80); // "matrix coefficient 1"
tomoya123 0:9a52d95a79f7 408 WriteReg(0x50, 0x80); // "matrix coefficient 2"
tomoya123 0:9a52d95a79f7 409 WriteReg(0x51, 0x00); // vb
tomoya123 0:9a52d95a79f7 410 WriteReg(0x52, 0x22); // "matrix coefficient 4"
tomoya123 0:9a52d95a79f7 411 WriteReg(0x53, 0x5e); // "matrix coefficient 5"
tomoya123 0:9a52d95a79f7 412 WriteReg(0x54, 0x80); // "matrix coefficient 6"
tomoya123 0:9a52d95a79f7 413 WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT|COM13_UVSWAP);
tomoya123 0:9a52d95a79f7 414 }
tomoya123 0:9a52d95a79f7 415
tomoya123 0:9a52d95a79f7 416 void HeptaCamera::InitBayerRGB(void){
tomoya123 0:9a52d95a79f7 417 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 418
tomoya123 0:9a52d95a79f7 419 // odd line BGBG... even line GRGR...
tomoya123 0:9a52d95a79f7 420 WriteReg(REG_COM7, reg_com7|COM7_BAYER);
tomoya123 0:9a52d95a79f7 421 // odd line GBGB... even line RGRG...
tomoya123 0:9a52d95a79f7 422 //WriteReg(REG_COM7, reg_com7|COM7_PBAYER);
tomoya123 0:9a52d95a79f7 423
tomoya123 0:9a52d95a79f7 424 WriteReg(REG_RGB444, RGB444_DISABLE);
tomoya123 0:9a52d95a79f7 425 WriteReg(REG_COM15, COM15_R00FF);
tomoya123 0:9a52d95a79f7 426
tomoya123 0:9a52d95a79f7 427 WriteReg(REG_COM13, 0x08); /* No gamma, magic rsvd bit */
tomoya123 0:9a52d95a79f7 428 WriteReg(REG_COM16, 0x3d); /* Edge enhancement, denoise */
tomoya123 0:9a52d95a79f7 429 WriteReg(REG_REG76, 0xe1); /* Pix correction, magic rsvd */
tomoya123 0:9a52d95a79f7 430
tomoya123 0:9a52d95a79f7 431 WriteReg(REG_TSLB, 0x04);
tomoya123 0:9a52d95a79f7 432 }
tomoya123 0:9a52d95a79f7 433
tomoya123 0:9a52d95a79f7 434 void HeptaCamera::InitVGA(void) {
tomoya123 0:9a52d95a79f7 435 // VGA
tomoya123 0:9a52d95a79f7 436 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 437
tomoya123 0:9a52d95a79f7 438 WriteReg(REG_COM7,reg_com7|COM7_VGA);
tomoya123 0:9a52d95a79f7 439
tomoya123 0:9a52d95a79f7 440 WriteReg(REG_HSTART,HSTART_VGA);
tomoya123 0:9a52d95a79f7 441 WriteReg(REG_HSTOP,HSTOP_VGA);
tomoya123 0:9a52d95a79f7 442 WriteReg(REG_HREF,HREF_VGA);
tomoya123 0:9a52d95a79f7 443 WriteReg(REG_VSTART,VSTART_VGA);
tomoya123 0:9a52d95a79f7 444 WriteReg(REG_VSTOP,VSTOP_VGA);
tomoya123 0:9a52d95a79f7 445 WriteReg(REG_VREF,VREF_VGA);
tomoya123 0:9a52d95a79f7 446 WriteReg(REG_COM3, COM3_VGA);
tomoya123 0:9a52d95a79f7 447 WriteReg(REG_COM14, COM14_VGA);
tomoya123 0:9a52d95a79f7 448 WriteReg(REG_SCALING_XSC, SCALING_XSC_VGA);
tomoya123 0:9a52d95a79f7 449 WriteReg(REG_SCALING_YSC, SCALING_YSC_VGA);
tomoya123 0:9a52d95a79f7 450 WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_VGA);
tomoya123 0:9a52d95a79f7 451 WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_VGA);
tomoya123 0:9a52d95a79f7 452 WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_VGA);
tomoya123 0:9a52d95a79f7 453 }
tomoya123 0:9a52d95a79f7 454
tomoya123 0:9a52d95a79f7 455 void HeptaCamera::InitFIFO_2bytes_color_nealy_limit_size(void) {
tomoya123 0:9a52d95a79f7 456 // nealy FIFO limit 544x360
tomoya123 0:9a52d95a79f7 457 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 458
tomoya123 0:9a52d95a79f7 459 WriteReg(REG_COM7,reg_com7|COM7_VGA);
tomoya123 0:9a52d95a79f7 460
tomoya123 0:9a52d95a79f7 461 WriteReg(REG_HSTART,HSTART_VGA);
tomoya123 0:9a52d95a79f7 462 WriteReg(REG_HSTOP,HSTOP_VGA);
tomoya123 0:9a52d95a79f7 463 WriteReg(REG_HREF,HREF_VGA);
tomoya123 0:9a52d95a79f7 464 WriteReg(REG_VSTART,VSTART_VGA);
tomoya123 0:9a52d95a79f7 465 WriteReg(REG_VSTOP,VSTOP_VGA);
tomoya123 0:9a52d95a79f7 466 WriteReg(REG_VREF,VREF_VGA);
tomoya123 0:9a52d95a79f7 467 WriteReg(REG_COM3, COM3_VGA);
tomoya123 0:9a52d95a79f7 468 WriteReg(REG_COM14, COM14_VGA);
tomoya123 0:9a52d95a79f7 469 WriteReg(REG_SCALING_XSC, SCALING_XSC_VGA);
tomoya123 0:9a52d95a79f7 470 WriteReg(REG_SCALING_YSC, SCALING_YSC_VGA);
tomoya123 0:9a52d95a79f7 471 WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_VGA);
tomoya123 0:9a52d95a79f7 472 WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_VGA);
tomoya123 0:9a52d95a79f7 473 WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_VGA);
tomoya123 0:9a52d95a79f7 474
tomoya123 0:9a52d95a79f7 475 WriteReg(REG_HSTART, 0x17);
tomoya123 0:9a52d95a79f7 476 WriteReg(REG_HSTOP, 0x5b);
tomoya123 0:9a52d95a79f7 477 WriteReg(REG_VSTART, 0x12);
tomoya123 0:9a52d95a79f7 478 WriteReg(REG_VSTOP, 0x6c);
tomoya123 0:9a52d95a79f7 479 }
tomoya123 0:9a52d95a79f7 480
tomoya123 0:9a52d95a79f7 481 void HeptaCamera::InitVGA_3_4(void) {
tomoya123 0:9a52d95a79f7 482 // VGA 3/4 -> 480x360
tomoya123 0:9a52d95a79f7 483 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 484
tomoya123 0:9a52d95a79f7 485 WriteReg(REG_COM7,reg_com7|COM7_VGA);
tomoya123 0:9a52d95a79f7 486
tomoya123 0:9a52d95a79f7 487 WriteReg(REG_HSTART,HSTART_VGA);
tomoya123 0:9a52d95a79f7 488 WriteReg(REG_HSTOP,HSTOP_VGA);
tomoya123 0:9a52d95a79f7 489 WriteReg(REG_HREF,HREF_VGA);
tomoya123 0:9a52d95a79f7 490 WriteReg(REG_VSTART,VSTART_VGA);
tomoya123 0:9a52d95a79f7 491 WriteReg(REG_VSTOP,VSTOP_VGA);
tomoya123 0:9a52d95a79f7 492 WriteReg(REG_VREF,VREF_VGA);
tomoya123 0:9a52d95a79f7 493 WriteReg(REG_COM3, COM3_VGA);
tomoya123 0:9a52d95a79f7 494 WriteReg(REG_COM14, COM14_VGA);
tomoya123 0:9a52d95a79f7 495 WriteReg(REG_SCALING_XSC, SCALING_XSC_VGA);
tomoya123 0:9a52d95a79f7 496 WriteReg(REG_SCALING_YSC, SCALING_YSC_VGA);
tomoya123 0:9a52d95a79f7 497 WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_VGA);
tomoya123 0:9a52d95a79f7 498 WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_VGA);
tomoya123 0:9a52d95a79f7 499 WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_VGA);
tomoya123 0:9a52d95a79f7 500
tomoya123 0:9a52d95a79f7 501 WriteReg(REG_HSTART, 0x1b);
tomoya123 0:9a52d95a79f7 502 WriteReg(REG_HSTOP, 0x57);
tomoya123 0:9a52d95a79f7 503 WriteReg(REG_VSTART, 0x12);
tomoya123 0:9a52d95a79f7 504 WriteReg(REG_VSTOP, 0x6c);
tomoya123 0:9a52d95a79f7 505 }
tomoya123 0:9a52d95a79f7 506
tomoya123 0:9a52d95a79f7 507 void HeptaCamera::InitQVGA(void) {
tomoya123 0:9a52d95a79f7 508 // QQVGA
tomoya123 0:9a52d95a79f7 509 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 510
tomoya123 0:9a52d95a79f7 511 WriteReg(REG_COM7,reg_com7|COM7_QVGA);
tomoya123 0:9a52d95a79f7 512
tomoya123 0:9a52d95a79f7 513 WriteReg(REG_HSTART,HSTART_QVGA);
tomoya123 0:9a52d95a79f7 514 WriteReg(REG_HSTOP,HSTOP_QVGA);
tomoya123 0:9a52d95a79f7 515 WriteReg(REG_HREF,HREF_QVGA);
tomoya123 0:9a52d95a79f7 516 WriteReg(REG_VSTART,VSTART_QVGA);
tomoya123 0:9a52d95a79f7 517 WriteReg(REG_VSTOP,VSTOP_QVGA);
tomoya123 0:9a52d95a79f7 518 WriteReg(REG_VREF,VREF_QVGA);
tomoya123 0:9a52d95a79f7 519 WriteReg(REG_COM3, COM3_QVGA);
tomoya123 0:9a52d95a79f7 520 WriteReg(REG_COM14, COM14_QVGA);
tomoya123 0:9a52d95a79f7 521 WriteReg(REG_SCALING_XSC, SCALING_XSC_QVGA);
tomoya123 0:9a52d95a79f7 522 WriteReg(REG_SCALING_YSC, SCALING_YSC_QVGA);
tomoya123 0:9a52d95a79f7 523 WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_QVGA);
tomoya123 0:9a52d95a79f7 524 WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_QVGA);
tomoya123 0:9a52d95a79f7 525 WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_QVGA);
tomoya123 0:9a52d95a79f7 526 }
tomoya123 0:9a52d95a79f7 527
tomoya123 0:9a52d95a79f7 528 void HeptaCamera::InitQQVGA(void) {
tomoya123 0:9a52d95a79f7 529 // QQVGA
tomoya123 0:9a52d95a79f7 530 int reg_com7 = ReadReg(REG_COM7);
tomoya123 0:9a52d95a79f7 531
tomoya123 0:9a52d95a79f7 532 WriteReg(REG_COM7,reg_com7|COM7_QQVGA);
tomoya123 0:9a52d95a79f7 533
tomoya123 0:9a52d95a79f7 534 WriteReg(REG_HSTART,HSTART_QQVGA);
tomoya123 0:9a52d95a79f7 535 WriteReg(REG_HSTOP,HSTOP_QQVGA);
tomoya123 0:9a52d95a79f7 536 WriteReg(REG_HREF,HREF_QQVGA);
tomoya123 0:9a52d95a79f7 537 WriteReg(REG_VSTART,VSTART_QQVGA);
tomoya123 0:9a52d95a79f7 538 WriteReg(REG_VSTOP,VSTOP_QQVGA);
tomoya123 0:9a52d95a79f7 539 WriteReg(REG_VREF,VREF_QQVGA);
tomoya123 0:9a52d95a79f7 540 WriteReg(REG_COM3, COM3_QQVGA);
tomoya123 0:9a52d95a79f7 541 WriteReg(REG_COM14, COM14_QQVGA);
tomoya123 0:9a52d95a79f7 542 WriteReg(REG_SCALING_XSC, SCALING_XSC_QQVGA);
tomoya123 0:9a52d95a79f7 543 WriteReg(REG_SCALING_YSC, SCALING_YSC_QQVGA);
tomoya123 0:9a52d95a79f7 544 WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_QQVGA);
tomoya123 0:9a52d95a79f7 545 WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_QQVGA);
tomoya123 0:9a52d95a79f7 546 WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_QQVGA);
tomoya123 0:9a52d95a79f7 547 }
tomoya123 0:9a52d95a79f7 548
tomoya123 0:9a52d95a79f7 549 // vsync handler
tomoya123 0:9a52d95a79f7 550 void HeptaCamera::VsyncHandler(void)
tomoya123 0:9a52d95a79f7 551 {
tomoya123 0:9a52d95a79f7 552 // Capture Enable
tomoya123 0:9a52d95a79f7 553 if (CaptureReq) {
tomoya123 0:9a52d95a79f7 554 wen = 1;
tomoya123 0:9a52d95a79f7 555 Done = false;
tomoya123 0:9a52d95a79f7 556 CaptureReq = false;
tomoya123 0:9a52d95a79f7 557 } else {
tomoya123 0:9a52d95a79f7 558 wen = 0;
tomoya123 0:9a52d95a79f7 559 if (Busy) {
tomoya123 0:9a52d95a79f7 560 Busy = false;
tomoya123 0:9a52d95a79f7 561 Done = true;
tomoya123 0:9a52d95a79f7 562 }
tomoya123 0:9a52d95a79f7 563 }
tomoya123 0:9a52d95a79f7 564
tomoya123 0:9a52d95a79f7 565 // Hline Counter
tomoya123 0:9a52d95a79f7 566 LastLines = LineCounter;
tomoya123 0:9a52d95a79f7 567 LineCounter = 0;
tomoya123 0:9a52d95a79f7 568 }
tomoya123 0:9a52d95a79f7 569
tomoya123 0:9a52d95a79f7 570 // href handler
tomoya123 0:9a52d95a79f7 571 void HeptaCamera::HrefHandler(void)
tomoya123 0:9a52d95a79f7 572 {
tomoya123 0:9a52d95a79f7 573 LineCounter++;
tomoya123 0:9a52d95a79f7 574 }
tomoya123 0:9a52d95a79f7 575
tomoya123 0:9a52d95a79f7 576 // Data Read
tomoya123 0:9a52d95a79f7 577 int HeptaCamera::ReadOneByte(void)
tomoya123 0:9a52d95a79f7 578 {
tomoya123 0:9a52d95a79f7 579 int result;
tomoya123 0:9a52d95a79f7 580 rclk = 1;
tomoya123 0:9a52d95a79f7 581 // wait_us(1);
tomoya123 0:9a52d95a79f7 582 result = data;
tomoya123 0:9a52d95a79f7 583 rclk = 0;
tomoya123 0:9a52d95a79f7 584 return result;
tomoya123 0:9a52d95a79f7 585 }
tomoya123 0:9a52d95a79f7 586
tomoya123 0:9a52d95a79f7 587 // Data Start
tomoya123 0:9a52d95a79f7 588 void HeptaCamera::ReadStart(void)
tomoya123 0:9a52d95a79f7 589 {
tomoya123 0:9a52d95a79f7 590 rrst = 0;
tomoya123 0:9a52d95a79f7 591 oe = 0;
tomoya123 0:9a52d95a79f7 592 wait_us(1);
tomoya123 0:9a52d95a79f7 593 rclk = 0;
tomoya123 0:9a52d95a79f7 594 wait_us(1);
tomoya123 0:9a52d95a79f7 595 rclk = 1;
tomoya123 0:9a52d95a79f7 596 wait_us(1);
tomoya123 0:9a52d95a79f7 597 rrst = 1;
tomoya123 0:9a52d95a79f7 598 }
tomoya123 0:9a52d95a79f7 599
tomoya123 0:9a52d95a79f7 600 // Data Stop
tomoya123 0:9a52d95a79f7 601 void HeptaCamera::ReadStop(void)
tomoya123 0:9a52d95a79f7 602 {
tomoya123 0:9a52d95a79f7 603 oe = 1;
tomoya123 0:9a52d95a79f7 604 ReadOneByte();
tomoya123 0:9a52d95a79f7 605 rclk = 1;
tomoya123 0:9a52d95a79f7 606 }
tomoya123 0:9a52d95a79f7 607
tomoya123 0:9a52d95a79f7 608 void HeptaCamera::shoot()
tomoya123 0:9a52d95a79f7 609 {
tomoya123 0:9a52d95a79f7 610 //pc.baud(115200);
tomoya123 0:9a52d95a79f7 611
tomoya123 0:9a52d95a79f7 612 //pc.printf("Camera resetting..\r\n");
tomoya123 0:9a52d95a79f7 613 HeptaCamera::Reset();
tomoya123 0:9a52d95a79f7 614
tomoya123 0:9a52d95a79f7 615 //pc.printf("Before Init...\r\n");
tomoya123 0:9a52d95a79f7 616 HeptaCamera::PrintRegister();
tomoya123 0:9a52d95a79f7 617 char color_format = '1';
tomoya123 0:9a52d95a79f7 618 /*pc.printf("Select color format.\r\n") ;
tomoya123 0:9a52d95a79f7 619 pc.printf("1: RGB444.\r\n");
tomoya123 0:9a52d95a79f7 620 pc.printf("2: RGB555.\r\n");
tomoya123 0:9a52d95a79f7 621 pc.printf("3: RGB565.\r\n");
tomoya123 0:9a52d95a79f7 622 pc.printf("4: YUV(UYVY).\r\n");
tomoya123 0:9a52d95a79f7 623 pc.printf("5: Bayer RGB(BGBG... GRGR...).\r\n");*/
tomoya123 0:9a52d95a79f7 624
tomoya123 0:9a52d95a79f7 625 /*while(!pc.readable());
tomoya123 0:9a52d95a79f7 626 char color_format = pc.getc();
tomoya123 0:9a52d95a79f7 627 switch (color_format) {
tomoya123 0:9a52d95a79f7 628 case '1':
tomoya123 0:9a52d95a79f7 629 camera.InitRGB444();
tomoya123 0:9a52d95a79f7 630 break;
tomoya123 0:9a52d95a79f7 631 case '2':
tomoya123 0:9a52d95a79f7 632 camera.InitRGB555();
tomoya123 0:9a52d95a79f7 633 break;
tomoya123 0:9a52d95a79f7 634 case '3':
tomoya123 0:9a52d95a79f7 635 camera.InitRGB565();
tomoya123 0:9a52d95a79f7 636 break;
tomoya123 0:9a52d95a79f7 637 case '4':
tomoya123 0:9a52d95a79f7 638 camera.InitYUV();
tomoya123 0:9a52d95a79f7 639 break;
tomoya123 0:9a52d95a79f7 640 case '5':
tomoya123 0:9a52d95a79f7 641 camera.InitBayerRGB();
tomoya123 0:9a52d95a79f7 642 break;
tomoya123 0:9a52d95a79f7 643 }
tomoya123 0:9a52d95a79f7 644 pc.printf("select %c\r\n", color_format);
tomoya123 0:9a52d95a79f7 645
tomoya123 0:9a52d95a79f7 646 pc.printf("Select screen size.\r\n") ;
tomoya123 0:9a52d95a79f7 647 switch (color_format) {
tomoya123 0:9a52d95a79f7 648 case '5':
tomoya123 0:9a52d95a79f7 649 pc.printf("1: VGA(640x480).\r\n");
tomoya123 0:9a52d95a79f7 650 case '1':
tomoya123 0:9a52d95a79f7 651 case '2':
tomoya123 0:9a52d95a79f7 652 case '3':
tomoya123 0:9a52d95a79f7 653 case '4':
tomoya123 0:9a52d95a79f7 654 pc.printf("2: FIFO nealy limit(544x360).\r\n");
tomoya123 0:9a52d95a79f7 655 pc.printf("3: VGA*3/4(480x360).\r\n");
tomoya123 0:9a52d95a79f7 656 pc.printf("4: QVGA(320x240).\r\n");
tomoya123 0:9a52d95a79f7 657 pc.printf("5: QQVGA(160x120).\r\n");
tomoya123 0:9a52d95a79f7 658 break;
tomoya123 0:9a52d95a79f7 659 }
tomoya123 0:9a52d95a79f7 660 char screen_size = 4;
tomoya123 0:9a52d95a79f7 661 while(!pc.readable());
tomoya123 0:9a52d95a79f7 662 char screen_size = pc.getc() ;
tomoya123 0:9a52d95a79f7 663 switch (screen_size) {
tomoya123 0:9a52d95a79f7 664 case '1':
tomoya123 0:9a52d95a79f7 665 sizex = 640;
tomoya123 0:9a52d95a79f7 666 sizey = 480;
tomoya123 0:9a52d95a79f7 667 camera.InitVGA();
tomoya123 0:9a52d95a79f7 668 break;
tomoya123 0:9a52d95a79f7 669 case '2':
tomoya123 0:9a52d95a79f7 670 sizex = 544;
tomoya123 0:9a52d95a79f7 671 sizey = 360;
tomoya123 0:9a52d95a79f7 672 camera.InitFIFO_2bytes_color_nealy_limit_size();
tomoya123 0:9a52d95a79f7 673 break;
tomoya123 0:9a52d95a79f7 674 case '3':
tomoya123 0:9a52d95a79f7 675 sizex = 480;
tomoya123 0:9a52d95a79f7 676 sizey = 360;
tomoya123 0:9a52d95a79f7 677 camera.InitVGA_3_4();
tomoya123 0:9a52d95a79f7 678 break;
tomoya123 0:9a52d95a79f7 679 case '4':
tomoya123 0:9a52d95a79f7 680 sizex = 320;
tomoya123 0:9a52d95a79f7 681 sizey = 240;
tomoya123 0:9a52d95a79f7 682 camera.InitQVGA();
tomoya123 0:9a52d95a79f7 683 break;
tomoya123 0:9a52d95a79f7 684 case '5':
tomoya123 0:9a52d95a79f7 685 sizex = 160;
tomoya123 0:9a52d95a79f7 686 sizey = 120;
tomoya123 0:9a52d95a79f7 687 camera.InitQQVGA();
tomoya123 0:9a52d95a79f7 688 break;
tomoya123 0:9a52d95a79f7 689 }
tomoya123 0:9a52d95a79f7 690 pc.printf("select %c\r\n", screen_size);*/
tomoya123 0:9a52d95a79f7 691 char screen_size = '4';
tomoya123 0:9a52d95a79f7 692 HeptaCamera::InitRGB444();
tomoya123 0:9a52d95a79f7 693 sizex = 320;
tomoya123 0:9a52d95a79f7 694 sizey = 240;
tomoya123 0:9a52d95a79f7 695 HeptaCamera::InitQVGA();
tomoya123 0:9a52d95a79f7 696 HeptaCamera::InitForFIFOWriteReset();
tomoya123 0:9a52d95a79f7 697 HeptaCamera::InitDefaultReg();
tomoya123 0:9a52d95a79f7 698
tomoya123 0:9a52d95a79f7 699 #ifdef COLORBAR
tomoya123 0:9a52d95a79f7 700 HeptaCamera::InitSetColorbar();
tomoya123 0:9a52d95a79f7 701 #endif
tomoya123 0:9a52d95a79f7 702
tomoya123 0:9a52d95a79f7 703 //pc.printf("After Init...\r\n");
tomoya123 0:9a52d95a79f7 704 HeptaCamera::PrintRegister();
tomoya123 0:9a52d95a79f7 705
tomoya123 0:9a52d95a79f7 706 // CAPTURE and SEND LOOP
tomoya123 0:9a52d95a79f7 707
tomoya123 0:9a52d95a79f7 708 #if defined(BITMAPFILE) || defined(BAYERBITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 709 //pc.printf("Hit Any Key %dx%d Capture Data.\r\n", sizex, sizey) ;
tomoya123 0:9a52d95a79f7 710 //while(!pc.readable());
tomoya123 0:9a52d95a79f7 711 //pc.printf("*\r\n");
tomoya123 0:9a52d95a79f7 712 //pc.getc();
tomoya123 0:9a52d95a79f7 713
tomoya123 0:9a52d95a79f7 714 int real_width = sizex*3 + sizey%4;
tomoya123 0:9a52d95a79f7 715
tomoya123 0:9a52d95a79f7 716 unsigned char *bmp_line_data; //画像1行分のRGB情報を格納する
tomoya123 0:9a52d95a79f7 717 if((bmp_line_data = (unsigned char *)malloc(sizeof(unsigned char)*real_width)) == NULL){
tomoya123 0:9a52d95a79f7 718 fprintf(stderr, "Error: Allocation error.\n");
tomoya123 0:9a52d95a79f7 719 //return 1;
tomoya123 0:9a52d95a79f7 720 }
tomoya123 0:9a52d95a79f7 721
tomoya123 0:9a52d95a79f7 722 //RGB情報を4バイトの倍数に合わせている
tomoya123 0:9a52d95a79f7 723 for(int i=sizex*3; i<real_width; i++){
tomoya123 0:9a52d95a79f7 724 bmp_line_data[i] = 0;
tomoya123 0:9a52d95a79f7 725 }
tomoya123 0:9a52d95a79f7 726 #endif
tomoya123 0:9a52d95a79f7 727 #if defined(BITMAPFILE) || defined(BAYERBITMAPFILE)
tomoya123 0:9a52d95a79f7 728 FILE *fp;
tomoya123 0:9a52d95a79f7 729 char *filename = "/local/test.bmp";
tomoya123 0:9a52d95a79f7 730 if((fp = fopen(filename, "wb")) == NULL){
tomoya123 0:9a52d95a79f7 731 //pc.printf("Error: %s could not open.", filename);
tomoya123 0:9a52d95a79f7 732 //return 1;
tomoya123 0:9a52d95a79f7 733 }
tomoya123 0:9a52d95a79f7 734
tomoya123 0:9a52d95a79f7 735 create_header(fp, sizex, sizey);
tomoya123 0:9a52d95a79f7 736 #endif
tomoya123 0:9a52d95a79f7 737 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 738 FILE *fp2;
tomoya123 0:9a52d95a79f7 739 char *filename2 = "/local/test.txt";
tomoya123 0:9a52d95a79f7 740 if((fp2 = fopen(filename2, "w")) == NULL){
tomoya123 0:9a52d95a79f7 741 pc.printf("Error: %s could not open.", filename2);
tomoya123 0:9a52d95a79f7 742 return 1;
tomoya123 0:9a52d95a79f7 743 }
tomoya123 0:9a52d95a79f7 744 #endif
tomoya123 0:9a52d95a79f7 745
tomoya123 0:9a52d95a79f7 746 HeptaCamera::CaptureNext();
tomoya123 0:9a52d95a79f7 747 while(HeptaCamera::CaptureDone() == false);
tomoya123 0:9a52d95a79f7 748 HeptaCamera::ReadStart();
tomoya123 0:9a52d95a79f7 749
tomoya123 0:9a52d95a79f7 750 int r=0, g=0, b=0, d1, d2;
tomoya123 0:9a52d95a79f7 751
tomoya123 0:9a52d95a79f7 752 switch (color_format) {
tomoya123 0:9a52d95a79f7 753 case '1':
tomoya123 0:9a52d95a79f7 754 case '2':
tomoya123 0:9a52d95a79f7 755 case '3':
tomoya123 0:9a52d95a79f7 756
tomoya123 0:9a52d95a79f7 757 for (int y=0; y<sizey; y++) {
tomoya123 0:9a52d95a79f7 758 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 759 d1 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 760 d2 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 761
tomoya123 0:9a52d95a79f7 762 switch (color_format) {
tomoya123 0:9a52d95a79f7 763 case '1':
tomoya123 0:9a52d95a79f7 764 // RGB444 to RGB888
tomoya123 0:9a52d95a79f7 765 b = (d1 & 0x0F) << 4;
tomoya123 0:9a52d95a79f7 766 g = (d2 & 0xF0);
tomoya123 0:9a52d95a79f7 767 r = (d2 & 0x0F) << 4;
tomoya123 0:9a52d95a79f7 768 break;
tomoya123 0:9a52d95a79f7 769 case '2':
tomoya123 0:9a52d95a79f7 770 // RGB555 to RGB888
tomoya123 0:9a52d95a79f7 771 b = (d1 & 0x1F) << 3;
tomoya123 0:9a52d95a79f7 772 g = (((d1 & 0xE0) >> 2) | ((d2 & 0x03) << 6));
tomoya123 0:9a52d95a79f7 773 r = (d2 & 0x7c) << 1;
tomoya123 0:9a52d95a79f7 774 break;
tomoya123 0:9a52d95a79f7 775 case '3':
tomoya123 0:9a52d95a79f7 776 // RGB565 to RGB888
tomoya123 0:9a52d95a79f7 777 b = (d1 & 0x1F) << 3;
tomoya123 0:9a52d95a79f7 778 g = (((d1 & 0xE0) >> 3) | ((d2 & 0x07) << 5));
tomoya123 0:9a52d95a79f7 779 r = (d2 & 0xF8);
tomoya123 0:9a52d95a79f7 780 break;
tomoya123 0:9a52d95a79f7 781 }
tomoya123 0:9a52d95a79f7 782 #if defined(BITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 783 bmp_line_data[x*3] = (unsigned char)b;
tomoya123 0:9a52d95a79f7 784 bmp_line_data[x*3 + 1] = (unsigned char)g;
tomoya123 0:9a52d95a79f7 785 bmp_line_data[x*3 + 2] = (unsigned char)r;
tomoya123 0:9a52d95a79f7 786 #endif
tomoya123 0:9a52d95a79f7 787 /*
tomoya123 0:9a52d95a79f7 788 // RGB
tomoya123 0:9a52d95a79f7 789 pc.printf ("%2X%2X%2X", r, g, b) ;
tomoya123 0:9a52d95a79f7 790 */
tomoya123 0:9a52d95a79f7 791 }
tomoya123 0:9a52d95a79f7 792 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 793 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 794 #endif
tomoya123 0:9a52d95a79f7 795 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 796 for(int i=0; i<sizex*3; i++){
tomoya123 0:9a52d95a79f7 797 fprintf(fp2, "%02X", bmp_line_data[i]);
tomoya123 0:9a52d95a79f7 798 }
tomoya123 0:9a52d95a79f7 799 #endif
tomoya123 0:9a52d95a79f7 800 // pc.printf("\r\n") ;
tomoya123 0:9a52d95a79f7 801 }
tomoya123 0:9a52d95a79f7 802 break;
tomoya123 0:9a52d95a79f7 803
tomoya123 0:9a52d95a79f7 804 case '4':
tomoya123 0:9a52d95a79f7 805 int index = 0;
tomoya123 0:9a52d95a79f7 806 for (int y=0; y<sizey; y++) {
tomoya123 0:9a52d95a79f7 807 int U0=0, Y0=0, V0=0, Y1=0;
tomoya123 0:9a52d95a79f7 808 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 809 if(index%2 == 0) {
tomoya123 0:9a52d95a79f7 810 U0 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 811 Y0 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 812 V0 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 813 Y1 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 814
tomoya123 0:9a52d95a79f7 815 b = Y0 + 1.77200 * (U0 - 128);
tomoya123 0:9a52d95a79f7 816 g = Y0 - 0.34414 * (U0 - 128) - 0.71414 * (V0 - 128);
tomoya123 0:9a52d95a79f7 817 r = Y0 + 1.40200 * (V0 - 128);
tomoya123 0:9a52d95a79f7 818 } else {
tomoya123 0:9a52d95a79f7 819 b = Y1 + 1.77200 * (U0 - 128);
tomoya123 0:9a52d95a79f7 820 g = Y1 - 0.34414 * (U0 - 128) - 0.71414 * (V0 - 128);
tomoya123 0:9a52d95a79f7 821 r = Y1 + 1.40200 * (V0 - 128);
tomoya123 0:9a52d95a79f7 822 }
tomoya123 0:9a52d95a79f7 823
tomoya123 0:9a52d95a79f7 824 b = min(max(b, 0), 255);
tomoya123 0:9a52d95a79f7 825 g = min(max(g, 0), 255);
tomoya123 0:9a52d95a79f7 826 r = min(max(r, 0), 255);
tomoya123 0:9a52d95a79f7 827
tomoya123 0:9a52d95a79f7 828 #if defined(BITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 829 bmp_line_data[x*3] = (unsigned char)b;
tomoya123 0:9a52d95a79f7 830 bmp_line_data[x*3 + 1] = (unsigned char)g;
tomoya123 0:9a52d95a79f7 831 bmp_line_data[x*3 + 2] = (unsigned char)r;
tomoya123 0:9a52d95a79f7 832 #endif
tomoya123 0:9a52d95a79f7 833 /*
tomoya123 0:9a52d95a79f7 834 // RGB
tomoya123 0:9a52d95a79f7 835 pc.printf ("%2X%2X%2X", r, g, b) ;
tomoya123 0:9a52d95a79f7 836 */
tomoya123 0:9a52d95a79f7 837 index++;
tomoya123 0:9a52d95a79f7 838 }
tomoya123 0:9a52d95a79f7 839 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 840 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 841 #endif
tomoya123 0:9a52d95a79f7 842 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 843 for(int i=0; i<sizex*3; i++){
tomoya123 0:9a52d95a79f7 844 fprintf(fp2, "%02X", bmp_line_data[i]);
tomoya123 0:9a52d95a79f7 845 }
tomoya123 0:9a52d95a79f7 846 #endif
tomoya123 0:9a52d95a79f7 847 // pc.printf("\r\n") ;
tomoya123 0:9a52d95a79f7 848 }
tomoya123 0:9a52d95a79f7 849 break;
tomoya123 0:9a52d95a79f7 850
tomoya123 0:9a52d95a79f7 851 case '5':
tomoya123 0:9a52d95a79f7 852 unsigned char *bayer_line[2];
tomoya123 0:9a52d95a79f7 853 unsigned char *bayer_line_data[2]; //画像1行分のRGB情報を格納する2行分
tomoya123 0:9a52d95a79f7 854 for(int i=0; i<2; i++) {
tomoya123 0:9a52d95a79f7 855 if((bayer_line_data[i] = (unsigned char *)malloc(sizeof(unsigned char)*sizex)) == NULL){
tomoya123 0:9a52d95a79f7 856 fprintf(stderr, "Error: Allocation error.\n");
tomoya123 0:9a52d95a79f7 857 //return 1;
tomoya123 0:9a52d95a79f7 858 }
tomoya123 0:9a52d95a79f7 859 }
tomoya123 0:9a52d95a79f7 860
tomoya123 0:9a52d95a79f7 861 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 862 // odd line BGBG... even line GRGR...
tomoya123 0:9a52d95a79f7 863 bayer_line_data[0][x] = (unsigned char)HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 864 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 865 bmp_line_data[x*3] = (unsigned char)bayer_line_data[0][x];
tomoya123 0:9a52d95a79f7 866 bmp_line_data[x*3 + 1] = (unsigned char)bayer_line_data[0][x];
tomoya123 0:9a52d95a79f7 867 bmp_line_data[x*3 + 2] = (unsigned char)bayer_line_data[0][x];
tomoya123 0:9a52d95a79f7 868 #endif
tomoya123 0:9a52d95a79f7 869 }
tomoya123 0:9a52d95a79f7 870 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 871 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 872 #endif
tomoya123 0:9a52d95a79f7 873 bayer_line[1] = bayer_line_data[0];
tomoya123 0:9a52d95a79f7 874
tomoya123 0:9a52d95a79f7 875 for (int y=1; y<sizey; y++) {
tomoya123 0:9a52d95a79f7 876 int line = y%2;
tomoya123 0:9a52d95a79f7 877
tomoya123 0:9a52d95a79f7 878 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 879 // odd line BGBG... even line GRGR...
tomoya123 0:9a52d95a79f7 880 bayer_line_data[line][x] = (unsigned char)HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 881 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 882 bmp_line_data[x*3] = (unsigned char)bayer_line_data[line][x];
tomoya123 0:9a52d95a79f7 883 bmp_line_data[x*3 + 1] = (unsigned char)bayer_line_data[line][x];
tomoya123 0:9a52d95a79f7 884 bmp_line_data[x*3 + 2] = (unsigned char)bayer_line_data[line][x];
tomoya123 0:9a52d95a79f7 885 #endif
tomoya123 0:9a52d95a79f7 886 }
tomoya123 0:9a52d95a79f7 887 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 888 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 889 #endif
tomoya123 0:9a52d95a79f7 890 bayer_line[0] = bayer_line[1];
tomoya123 0:9a52d95a79f7 891 bayer_line[1] = bayer_line_data[line];
tomoya123 0:9a52d95a79f7 892
tomoya123 0:9a52d95a79f7 893 for (int x=0; x<sizex - 1; x++) {
tomoya123 0:9a52d95a79f7 894 if(y%2==1) {
tomoya123 0:9a52d95a79f7 895 if(x%2==0) {
tomoya123 0:9a52d95a79f7 896 // BG
tomoya123 0:9a52d95a79f7 897 // GR
tomoya123 0:9a52d95a79f7 898 b = bayer_line[0][x];
tomoya123 0:9a52d95a79f7 899 g = ((int)bayer_line[0][x+1] + bayer_line[1][x])>>1;
tomoya123 0:9a52d95a79f7 900 r = bayer_line[1][x+1];
tomoya123 0:9a52d95a79f7 901 } else {
tomoya123 0:9a52d95a79f7 902 // GB
tomoya123 0:9a52d95a79f7 903 // RG
tomoya123 0:9a52d95a79f7 904 b = bayer_line[0][x+1];
tomoya123 0:9a52d95a79f7 905 g = ((int)bayer_line[0][x] + bayer_line[1][x+1])>>1;
tomoya123 0:9a52d95a79f7 906 r = bayer_line[1][x];
tomoya123 0:9a52d95a79f7 907 }
tomoya123 0:9a52d95a79f7 908 } else {
tomoya123 0:9a52d95a79f7 909 if(x%2==0) {
tomoya123 0:9a52d95a79f7 910 // GR
tomoya123 0:9a52d95a79f7 911 // BG
tomoya123 0:9a52d95a79f7 912 b = bayer_line[1][x];
tomoya123 0:9a52d95a79f7 913 g = ((int)bayer_line[0][x] + bayer_line[1][x+1])>>1;
tomoya123 0:9a52d95a79f7 914 r = bayer_line[0][x+1];
tomoya123 0:9a52d95a79f7 915 } else {
tomoya123 0:9a52d95a79f7 916 // RG
tomoya123 0:9a52d95a79f7 917 // GB
tomoya123 0:9a52d95a79f7 918 b = bayer_line[1][x+1];
tomoya123 0:9a52d95a79f7 919 g = ((int)bayer_line[0][x+1] + bayer_line[1][x])>>1;
tomoya123 0:9a52d95a79f7 920 r = bayer_line[0][x];
tomoya123 0:9a52d95a79f7 921 }
tomoya123 0:9a52d95a79f7 922 }
tomoya123 0:9a52d95a79f7 923 #if defined(BITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 924 bmp_line_data[x*3] = (unsigned char)b;
tomoya123 0:9a52d95a79f7 925 bmp_line_data[x*3 + 1] = (unsigned char)g;
tomoya123 0:9a52d95a79f7 926 bmp_line_data[x*3 + 2] = (unsigned char)r;
tomoya123 0:9a52d95a79f7 927 #endif
tomoya123 0:9a52d95a79f7 928 }
tomoya123 0:9a52d95a79f7 929
tomoya123 0:9a52d95a79f7 930 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 931 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 932 #endif
tomoya123 0:9a52d95a79f7 933
tomoya123 0:9a52d95a79f7 934 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 935 for(int i=0; i<sizex*3; i++){
tomoya123 0:9a52d95a79f7 936 fprintf(fp2, "%02X", bmp_line_data[i]);
tomoya123 0:9a52d95a79f7 937 }
tomoya123 0:9a52d95a79f7 938 #endif
tomoya123 0:9a52d95a79f7 939 }
tomoya123 0:9a52d95a79f7 940
tomoya123 0:9a52d95a79f7 941 for(int i=0; i<2; i++) {
tomoya123 0:9a52d95a79f7 942 free(bayer_line_data[i]);
tomoya123 0:9a52d95a79f7 943 }
tomoya123 0:9a52d95a79f7 944 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 945 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 946 #endif
tomoya123 0:9a52d95a79f7 947 break;
tomoya123 0:9a52d95a79f7 948 }
tomoya123 0:9a52d95a79f7 949 HeptaCamera::ReadStop();
tomoya123 0:9a52d95a79f7 950
tomoya123 0:9a52d95a79f7 951 #if defined(BITMAPFILE) || defined(BAYERBITMAPFILE)
tomoya123 0:9a52d95a79f7 952 free(bmp_line_data);
tomoya123 0:9a52d95a79f7 953 fclose(fp);
tomoya123 0:9a52d95a79f7 954 #endif
tomoya123 0:9a52d95a79f7 955 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 956 fclose(fp2);
tomoya123 0:9a52d95a79f7 957 #endif
tomoya123 0:9a52d95a79f7 958
tomoya123 0:9a52d95a79f7 959 }
tomoya123 0:9a52d95a79f7 960
tomoya123 0:9a52d95a79f7 961 void HeptaCamera::shoot2()
tomoya123 0:9a52d95a79f7 962 {
tomoya123 0:9a52d95a79f7 963 //pc.baud(115200);
tomoya123 0:9a52d95a79f7 964
tomoya123 0:9a52d95a79f7 965 //pc.printf("Camera resetting..\r\n");
tomoya123 0:9a52d95a79f7 966 HeptaCamera::Reset();
tomoya123 0:9a52d95a79f7 967
tomoya123 0:9a52d95a79f7 968 //pc.printf("Before Init...\r\n");
tomoya123 0:9a52d95a79f7 969 HeptaCamera::PrintRegister();
tomoya123 0:9a52d95a79f7 970 char color_format = '1';
tomoya123 0:9a52d95a79f7 971 /*pc.printf("Select color format.\r\n") ;
tomoya123 0:9a52d95a79f7 972 pc.printf("1: RGB444.\r\n");
tomoya123 0:9a52d95a79f7 973 pc.printf("2: RGB555.\r\n");
tomoya123 0:9a52d95a79f7 974 pc.printf("3: RGB565.\r\n");
tomoya123 0:9a52d95a79f7 975 pc.printf("4: YUV(UYVY).\r\n");
tomoya123 0:9a52d95a79f7 976 pc.printf("5: Bayer RGB(BGBG... GRGR...).\r\n");*/
tomoya123 0:9a52d95a79f7 977
tomoya123 0:9a52d95a79f7 978 /*while(!pc.readable());
tomoya123 0:9a52d95a79f7 979 char color_format = pc.getc();
tomoya123 0:9a52d95a79f7 980 switch (color_format) {
tomoya123 0:9a52d95a79f7 981 case '1':
tomoya123 0:9a52d95a79f7 982 camera.InitRGB444();
tomoya123 0:9a52d95a79f7 983 break;
tomoya123 0:9a52d95a79f7 984 case '2':
tomoya123 0:9a52d95a79f7 985 camera.InitRGB555();
tomoya123 0:9a52d95a79f7 986 break;
tomoya123 0:9a52d95a79f7 987 case '3':
tomoya123 0:9a52d95a79f7 988 camera.InitRGB565();
tomoya123 0:9a52d95a79f7 989 break;
tomoya123 0:9a52d95a79f7 990 case '4':
tomoya123 0:9a52d95a79f7 991 camera.InitYUV();
tomoya123 0:9a52d95a79f7 992 break;
tomoya123 0:9a52d95a79f7 993 case '5':
tomoya123 0:9a52d95a79f7 994 camera.InitBayerRGB();
tomoya123 0:9a52d95a79f7 995 break;
tomoya123 0:9a52d95a79f7 996 }
tomoya123 0:9a52d95a79f7 997 pc.printf("select %c\r\n", color_format);
tomoya123 0:9a52d95a79f7 998
tomoya123 0:9a52d95a79f7 999 pc.printf("Select screen size.\r\n") ;
tomoya123 0:9a52d95a79f7 1000 switch (color_format) {
tomoya123 0:9a52d95a79f7 1001 case '5':
tomoya123 0:9a52d95a79f7 1002 pc.printf("1: VGA(640x480).\r\n");
tomoya123 0:9a52d95a79f7 1003 case '1':
tomoya123 0:9a52d95a79f7 1004 case '2':
tomoya123 0:9a52d95a79f7 1005 case '3':
tomoya123 0:9a52d95a79f7 1006 case '4':
tomoya123 0:9a52d95a79f7 1007 pc.printf("2: FIFO nealy limit(544x360).\r\n");
tomoya123 0:9a52d95a79f7 1008 pc.printf("3: VGA*3/4(480x360).\r\n");
tomoya123 0:9a52d95a79f7 1009 pc.printf("4: QVGA(320x240).\r\n");
tomoya123 0:9a52d95a79f7 1010 pc.printf("5: QQVGA(160x120).\r\n");
tomoya123 0:9a52d95a79f7 1011 break;
tomoya123 0:9a52d95a79f7 1012 }
tomoya123 0:9a52d95a79f7 1013 char screen_size = 4;
tomoya123 0:9a52d95a79f7 1014 while(!pc.readable());
tomoya123 0:9a52d95a79f7 1015 char screen_size = pc.getc() ;
tomoya123 0:9a52d95a79f7 1016 switch (screen_size) {
tomoya123 0:9a52d95a79f7 1017 case '1':
tomoya123 0:9a52d95a79f7 1018 sizex = 640;
tomoya123 0:9a52d95a79f7 1019 sizey = 480;
tomoya123 0:9a52d95a79f7 1020 camera.InitVGA();
tomoya123 0:9a52d95a79f7 1021 break;
tomoya123 0:9a52d95a79f7 1022 case '2':
tomoya123 0:9a52d95a79f7 1023 sizex = 544;
tomoya123 0:9a52d95a79f7 1024 sizey = 360;
tomoya123 0:9a52d95a79f7 1025 camera.InitFIFO_2bytes_color_nealy_limit_size();
tomoya123 0:9a52d95a79f7 1026 break;
tomoya123 0:9a52d95a79f7 1027 case '3':
tomoya123 0:9a52d95a79f7 1028 sizex = 480;
tomoya123 0:9a52d95a79f7 1029 sizey = 360;
tomoya123 0:9a52d95a79f7 1030 camera.InitVGA_3_4();
tomoya123 0:9a52d95a79f7 1031 break;
tomoya123 0:9a52d95a79f7 1032 case '4':
tomoya123 0:9a52d95a79f7 1033 sizex = 320;
tomoya123 0:9a52d95a79f7 1034 sizey = 240;
tomoya123 0:9a52d95a79f7 1035 camera.InitQVGA();
tomoya123 0:9a52d95a79f7 1036 break;
tomoya123 0:9a52d95a79f7 1037 case '5':
tomoya123 0:9a52d95a79f7 1038 sizex = 160;
tomoya123 0:9a52d95a79f7 1039 sizey = 120;
tomoya123 0:9a52d95a79f7 1040 camera.InitQQVGA();
tomoya123 0:9a52d95a79f7 1041 break;
tomoya123 0:9a52d95a79f7 1042 }
tomoya123 0:9a52d95a79f7 1043 pc.printf("select %c\r\n", screen_size);*/
tomoya123 0:9a52d95a79f7 1044 char screen_size = '4';
tomoya123 0:9a52d95a79f7 1045 HeptaCamera::InitRGB444();
tomoya123 0:9a52d95a79f7 1046 sizex = 320;
tomoya123 0:9a52d95a79f7 1047 sizey = 240;
tomoya123 0:9a52d95a79f7 1048 HeptaCamera::InitQVGA();
tomoya123 0:9a52d95a79f7 1049 HeptaCamera::InitForFIFOWriteReset();
tomoya123 0:9a52d95a79f7 1050 HeptaCamera::InitDefaultReg();
tomoya123 0:9a52d95a79f7 1051
tomoya123 0:9a52d95a79f7 1052 #ifdef COLORBAR
tomoya123 0:9a52d95a79f7 1053 HeptaCamera::InitSetColorbar();
tomoya123 0:9a52d95a79f7 1054 #endif
tomoya123 0:9a52d95a79f7 1055
tomoya123 0:9a52d95a79f7 1056 //pc.printf("After Init...\r\n");
tomoya123 0:9a52d95a79f7 1057 HeptaCamera::PrintRegister();
tomoya123 0:9a52d95a79f7 1058
tomoya123 0:9a52d95a79f7 1059 // CAPTURE and SEND LOOP
tomoya123 0:9a52d95a79f7 1060
tomoya123 0:9a52d95a79f7 1061 #if defined(BITMAPFILE) || defined(BAYERBITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 1062 //pc.printf("Hit Any Key %dx%d Capture Data.\r\n", sizex, sizey) ;
tomoya123 0:9a52d95a79f7 1063 //while(!pc.readable());
tomoya123 0:9a52d95a79f7 1064 //pc.printf("*\r\n");
tomoya123 0:9a52d95a79f7 1065 //pc.getc();
tomoya123 0:9a52d95a79f7 1066
tomoya123 0:9a52d95a79f7 1067 int real_width = sizex*3 + sizey%4;
tomoya123 0:9a52d95a79f7 1068
tomoya123 0:9a52d95a79f7 1069 unsigned char *bmp_line_data; //画像1行分のRGB情報を格納する
tomoya123 0:9a52d95a79f7 1070 if((bmp_line_data = (unsigned char *)malloc(sizeof(unsigned char)*real_width)) == NULL){
tomoya123 0:9a52d95a79f7 1071 fprintf(stderr, "Error: Allocation error.\n");
tomoya123 0:9a52d95a79f7 1072 //return 1;
tomoya123 0:9a52d95a79f7 1073 }
tomoya123 0:9a52d95a79f7 1074
tomoya123 0:9a52d95a79f7 1075 //RGB情報を4バイトの倍数に合わせている
tomoya123 0:9a52d95a79f7 1076 for(int i=sizex*3; i<real_width; i++){
tomoya123 0:9a52d95a79f7 1077 bmp_line_data[i] = 0;
tomoya123 0:9a52d95a79f7 1078 }
tomoya123 0:9a52d95a79f7 1079 #endif
tomoya123 0:9a52d95a79f7 1080 #if defined(BITMAPFILE) || defined(BAYERBITMAPFILE)
tomoya123 0:9a52d95a79f7 1081 mkdir("/sd/mydir", 0777);
tomoya123 0:9a52d95a79f7 1082 FILE *fp = fopen("/sd/mydir/picture.bmp","w");
tomoya123 0:9a52d95a79f7 1083 if(fp == NULL) {
tomoya123 0:9a52d95a79f7 1084 error("Could not open file for write\r\n");
tomoya123 0:9a52d95a79f7 1085 }
tomoya123 0:9a52d95a79f7 1086
tomoya123 0:9a52d95a79f7 1087 create_header(fp, sizex, sizey);
tomoya123 0:9a52d95a79f7 1088 #endif
tomoya123 0:9a52d95a79f7 1089 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 1090 FILE *fp2;
tomoya123 0:9a52d95a79f7 1091 char *filename2 = "/local/test.txt";
tomoya123 0:9a52d95a79f7 1092 if((fp2 = fopen(filename2, "w")) == NULL){
tomoya123 0:9a52d95a79f7 1093 pc.printf("Error: %s could not open.", filename2);
tomoya123 0:9a52d95a79f7 1094 return 1;
tomoya123 0:9a52d95a79f7 1095 }
tomoya123 0:9a52d95a79f7 1096 #endif
tomoya123 0:9a52d95a79f7 1097
tomoya123 0:9a52d95a79f7 1098 HeptaCamera::CaptureNext();
tomoya123 0:9a52d95a79f7 1099 while(HeptaCamera::CaptureDone() == false);
tomoya123 0:9a52d95a79f7 1100 HeptaCamera::ReadStart();
tomoya123 0:9a52d95a79f7 1101
tomoya123 0:9a52d95a79f7 1102 int r=0, g=0, b=0, d1, d2;
tomoya123 0:9a52d95a79f7 1103
tomoya123 0:9a52d95a79f7 1104 switch (color_format) {
tomoya123 0:9a52d95a79f7 1105 case '1':
tomoya123 0:9a52d95a79f7 1106 case '2':
tomoya123 0:9a52d95a79f7 1107 case '3':
tomoya123 0:9a52d95a79f7 1108
tomoya123 0:9a52d95a79f7 1109 for (int y=0; y<sizey; y++) {
tomoya123 0:9a52d95a79f7 1110 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 1111 d1 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1112 d2 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1113
tomoya123 0:9a52d95a79f7 1114 switch (color_format) {
tomoya123 0:9a52d95a79f7 1115 case '1':
tomoya123 0:9a52d95a79f7 1116 // RGB444 to RGB888
tomoya123 0:9a52d95a79f7 1117 b = (d1 & 0x0F) << 4;
tomoya123 0:9a52d95a79f7 1118 g = (d2 & 0xF0);
tomoya123 0:9a52d95a79f7 1119 r = (d2 & 0x0F) << 4;
tomoya123 0:9a52d95a79f7 1120 break;
tomoya123 0:9a52d95a79f7 1121 case '2':
tomoya123 0:9a52d95a79f7 1122 // RGB555 to RGB888
tomoya123 0:9a52d95a79f7 1123 b = (d1 & 0x1F) << 3;
tomoya123 0:9a52d95a79f7 1124 g = (((d1 & 0xE0) >> 2) | ((d2 & 0x03) << 6));
tomoya123 0:9a52d95a79f7 1125 r = (d2 & 0x7c) << 1;
tomoya123 0:9a52d95a79f7 1126 break;
tomoya123 0:9a52d95a79f7 1127 case '3':
tomoya123 0:9a52d95a79f7 1128 // RGB565 to RGB888
tomoya123 0:9a52d95a79f7 1129 b = (d1 & 0x1F) << 3;
tomoya123 0:9a52d95a79f7 1130 g = (((d1 & 0xE0) >> 3) | ((d2 & 0x07) << 5));
tomoya123 0:9a52d95a79f7 1131 r = (d2 & 0xF8);
tomoya123 0:9a52d95a79f7 1132 break;
tomoya123 0:9a52d95a79f7 1133 }
tomoya123 0:9a52d95a79f7 1134 #if defined(BITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 1135 bmp_line_data[x*3] = (unsigned char)b;
tomoya123 0:9a52d95a79f7 1136 bmp_line_data[x*3 + 1] = (unsigned char)g;
tomoya123 0:9a52d95a79f7 1137 bmp_line_data[x*3 + 2] = (unsigned char)r;
tomoya123 0:9a52d95a79f7 1138 #endif
tomoya123 0:9a52d95a79f7 1139 /*
tomoya123 0:9a52d95a79f7 1140 // RGB
tomoya123 0:9a52d95a79f7 1141 pc.printf ("%2X%2X%2X", r, g, b) ;
tomoya123 0:9a52d95a79f7 1142 */
tomoya123 0:9a52d95a79f7 1143 }
tomoya123 0:9a52d95a79f7 1144 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 1145 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 1146 #endif
tomoya123 0:9a52d95a79f7 1147 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 1148 for(int i=0; i<sizex*3; i++){
tomoya123 0:9a52d95a79f7 1149 fprintf(fp2, "%02X", bmp_line_data[i]);
tomoya123 0:9a52d95a79f7 1150 }
tomoya123 0:9a52d95a79f7 1151 #endif
tomoya123 0:9a52d95a79f7 1152 // pc.printf("\r\n") ;
tomoya123 0:9a52d95a79f7 1153 }
tomoya123 0:9a52d95a79f7 1154 break;
tomoya123 0:9a52d95a79f7 1155
tomoya123 0:9a52d95a79f7 1156 case '4':
tomoya123 0:9a52d95a79f7 1157 int index = 0;
tomoya123 0:9a52d95a79f7 1158 for (int y=0; y<sizey; y++) {
tomoya123 0:9a52d95a79f7 1159 int U0=0, Y0=0, V0=0, Y1=0;
tomoya123 0:9a52d95a79f7 1160 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 1161 if(index%2 == 0) {
tomoya123 0:9a52d95a79f7 1162 U0 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1163 Y0 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1164 V0 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1165 Y1 = HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1166
tomoya123 0:9a52d95a79f7 1167 b = Y0 + 1.77200 * (U0 - 128);
tomoya123 0:9a52d95a79f7 1168 g = Y0 - 0.34414 * (U0 - 128) - 0.71414 * (V0 - 128);
tomoya123 0:9a52d95a79f7 1169 r = Y0 + 1.40200 * (V0 - 128);
tomoya123 0:9a52d95a79f7 1170 } else {
tomoya123 0:9a52d95a79f7 1171 b = Y1 + 1.77200 * (U0 - 128);
tomoya123 0:9a52d95a79f7 1172 g = Y1 - 0.34414 * (U0 - 128) - 0.71414 * (V0 - 128);
tomoya123 0:9a52d95a79f7 1173 r = Y1 + 1.40200 * (V0 - 128);
tomoya123 0:9a52d95a79f7 1174 }
tomoya123 0:9a52d95a79f7 1175
tomoya123 0:9a52d95a79f7 1176 b = min(max(b, 0), 255);
tomoya123 0:9a52d95a79f7 1177 g = min(max(g, 0), 255);
tomoya123 0:9a52d95a79f7 1178 r = min(max(r, 0), 255);
tomoya123 0:9a52d95a79f7 1179
tomoya123 0:9a52d95a79f7 1180 #if defined(BITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 1181 bmp_line_data[x*3] = (unsigned char)b;
tomoya123 0:9a52d95a79f7 1182 bmp_line_data[x*3 + 1] = (unsigned char)g;
tomoya123 0:9a52d95a79f7 1183 bmp_line_data[x*3 + 2] = (unsigned char)r;
tomoya123 0:9a52d95a79f7 1184 #endif
tomoya123 0:9a52d95a79f7 1185 /*
tomoya123 0:9a52d95a79f7 1186 // RGB
tomoya123 0:9a52d95a79f7 1187 pc.printf ("%2X%2X%2X", r, g, b) ;
tomoya123 0:9a52d95a79f7 1188 */
tomoya123 0:9a52d95a79f7 1189 index++;
tomoya123 0:9a52d95a79f7 1190 }
tomoya123 0:9a52d95a79f7 1191 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 1192 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 1193 #endif
tomoya123 0:9a52d95a79f7 1194 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 1195 for(int i=0; i<sizex*3; i++){
tomoya123 0:9a52d95a79f7 1196 fprintf(fp2, "%02X", bmp_line_data[i]);
tomoya123 0:9a52d95a79f7 1197 }
tomoya123 0:9a52d95a79f7 1198 #endif
tomoya123 0:9a52d95a79f7 1199 // pc.printf("\r\n") ;
tomoya123 0:9a52d95a79f7 1200 }
tomoya123 0:9a52d95a79f7 1201 break;
tomoya123 0:9a52d95a79f7 1202
tomoya123 0:9a52d95a79f7 1203 case '5':
tomoya123 0:9a52d95a79f7 1204 unsigned char *bayer_line[2];
tomoya123 0:9a52d95a79f7 1205 unsigned char *bayer_line_data[2]; //画像1行分のRGB情報を格納する2行分
tomoya123 0:9a52d95a79f7 1206 for(int i=0; i<2; i++) {
tomoya123 0:9a52d95a79f7 1207 if((bayer_line_data[i] = (unsigned char *)malloc(sizeof(unsigned char)*sizex)) == NULL){
tomoya123 0:9a52d95a79f7 1208 fprintf(stderr, "Error: Allocation error.\n");
tomoya123 0:9a52d95a79f7 1209 //return 1;
tomoya123 0:9a52d95a79f7 1210 }
tomoya123 0:9a52d95a79f7 1211 }
tomoya123 0:9a52d95a79f7 1212
tomoya123 0:9a52d95a79f7 1213 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 1214 // odd line BGBG... even line GRGR...
tomoya123 0:9a52d95a79f7 1215 bayer_line_data[0][x] = (unsigned char)HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1216 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 1217 bmp_line_data[x*3] = (unsigned char)bayer_line_data[0][x];
tomoya123 0:9a52d95a79f7 1218 bmp_line_data[x*3 + 1] = (unsigned char)bayer_line_data[0][x];
tomoya123 0:9a52d95a79f7 1219 bmp_line_data[x*3 + 2] = (unsigned char)bayer_line_data[0][x];
tomoya123 0:9a52d95a79f7 1220 #endif
tomoya123 0:9a52d95a79f7 1221 }
tomoya123 0:9a52d95a79f7 1222 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 1223 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 1224 #endif
tomoya123 0:9a52d95a79f7 1225 bayer_line[1] = bayer_line_data[0];
tomoya123 0:9a52d95a79f7 1226
tomoya123 0:9a52d95a79f7 1227 for (int y=1; y<sizey; y++) {
tomoya123 0:9a52d95a79f7 1228 int line = y%2;
tomoya123 0:9a52d95a79f7 1229
tomoya123 0:9a52d95a79f7 1230 for (int x=0; x<sizex; x++) {
tomoya123 0:9a52d95a79f7 1231 // odd line BGBG... even line GRGR...
tomoya123 0:9a52d95a79f7 1232 bayer_line_data[line][x] = (unsigned char)HeptaCamera::ReadOneByte();
tomoya123 0:9a52d95a79f7 1233 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 1234 bmp_line_data[x*3] = (unsigned char)bayer_line_data[line][x];
tomoya123 0:9a52d95a79f7 1235 bmp_line_data[x*3 + 1] = (unsigned char)bayer_line_data[line][x];
tomoya123 0:9a52d95a79f7 1236 bmp_line_data[x*3 + 2] = (unsigned char)bayer_line_data[line][x];
tomoya123 0:9a52d95a79f7 1237 #endif
tomoya123 0:9a52d95a79f7 1238 }
tomoya123 0:9a52d95a79f7 1239 #ifdef BAYERBITMAPFILE
tomoya123 0:9a52d95a79f7 1240 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 1241 #endif
tomoya123 0:9a52d95a79f7 1242 bayer_line[0] = bayer_line[1];
tomoya123 0:9a52d95a79f7 1243 bayer_line[1] = bayer_line_data[line];
tomoya123 0:9a52d95a79f7 1244
tomoya123 0:9a52d95a79f7 1245 for (int x=0; x<sizex - 1; x++) {
tomoya123 0:9a52d95a79f7 1246 if(y%2==1) {
tomoya123 0:9a52d95a79f7 1247 if(x%2==0) {
tomoya123 0:9a52d95a79f7 1248 // BG
tomoya123 0:9a52d95a79f7 1249 // GR
tomoya123 0:9a52d95a79f7 1250 b = bayer_line[0][x];
tomoya123 0:9a52d95a79f7 1251 g = ((int)bayer_line[0][x+1] + bayer_line[1][x])>>1;
tomoya123 0:9a52d95a79f7 1252 r = bayer_line[1][x+1];
tomoya123 0:9a52d95a79f7 1253 } else {
tomoya123 0:9a52d95a79f7 1254 // GB
tomoya123 0:9a52d95a79f7 1255 // RG
tomoya123 0:9a52d95a79f7 1256 b = bayer_line[0][x+1];
tomoya123 0:9a52d95a79f7 1257 g = ((int)bayer_line[0][x] + bayer_line[1][x+1])>>1;
tomoya123 0:9a52d95a79f7 1258 r = bayer_line[1][x];
tomoya123 0:9a52d95a79f7 1259 }
tomoya123 0:9a52d95a79f7 1260 } else {
tomoya123 0:9a52d95a79f7 1261 if(x%2==0) {
tomoya123 0:9a52d95a79f7 1262 // GR
tomoya123 0:9a52d95a79f7 1263 // BG
tomoya123 0:9a52d95a79f7 1264 b = bayer_line[1][x];
tomoya123 0:9a52d95a79f7 1265 g = ((int)bayer_line[0][x] + bayer_line[1][x+1])>>1;
tomoya123 0:9a52d95a79f7 1266 r = bayer_line[0][x+1];
tomoya123 0:9a52d95a79f7 1267 } else {
tomoya123 0:9a52d95a79f7 1268 // RG
tomoya123 0:9a52d95a79f7 1269 // GB
tomoya123 0:9a52d95a79f7 1270 b = bayer_line[1][x+1];
tomoya123 0:9a52d95a79f7 1271 g = ((int)bayer_line[0][x+1] + bayer_line[1][x])>>1;
tomoya123 0:9a52d95a79f7 1272 r = bayer_line[0][x];
tomoya123 0:9a52d95a79f7 1273 }
tomoya123 0:9a52d95a79f7 1274 }
tomoya123 0:9a52d95a79f7 1275 #if defined(BITMAPFILE) || defined(HEXFILE)
tomoya123 0:9a52d95a79f7 1276 bmp_line_data[x*3] = (unsigned char)b;
tomoya123 0:9a52d95a79f7 1277 bmp_line_data[x*3 + 1] = (unsigned char)g;
tomoya123 0:9a52d95a79f7 1278 bmp_line_data[x*3 + 2] = (unsigned char)r;
tomoya123 0:9a52d95a79f7 1279 #endif
tomoya123 0:9a52d95a79f7 1280 }
tomoya123 0:9a52d95a79f7 1281
tomoya123 0:9a52d95a79f7 1282 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 1283 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 1284 #endif
tomoya123 0:9a52d95a79f7 1285
tomoya123 0:9a52d95a79f7 1286 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 1287 for(int i=0; i<sizex*3; i++){
tomoya123 0:9a52d95a79f7 1288 fprintf(fp2, "%02X", bmp_line_data[i]);
tomoya123 0:9a52d95a79f7 1289 }
tomoya123 0:9a52d95a79f7 1290 #endif
tomoya123 0:9a52d95a79f7 1291 }
tomoya123 0:9a52d95a79f7 1292
tomoya123 0:9a52d95a79f7 1293 for(int i=0; i<2; i++) {
tomoya123 0:9a52d95a79f7 1294 free(bayer_line_data[i]);
tomoya123 0:9a52d95a79f7 1295 }
tomoya123 0:9a52d95a79f7 1296 #ifdef BITMAPFILE
tomoya123 0:9a52d95a79f7 1297 fwrite(bmp_line_data, sizeof(unsigned char), real_width, fp);
tomoya123 0:9a52d95a79f7 1298 #endif
tomoya123 0:9a52d95a79f7 1299 break;
tomoya123 0:9a52d95a79f7 1300 }
tomoya123 0:9a52d95a79f7 1301 HeptaCamera::ReadStop();
tomoya123 0:9a52d95a79f7 1302
tomoya123 0:9a52d95a79f7 1303 #if defined(BITMAPFILE) || defined(BAYERBITMAPFILE)
tomoya123 0:9a52d95a79f7 1304 free(bmp_line_data);
tomoya123 0:9a52d95a79f7 1305 fclose(fp);
tomoya123 0:9a52d95a79f7 1306 #endif
tomoya123 0:9a52d95a79f7 1307 #ifdef HEXFILE
tomoya123 0:9a52d95a79f7 1308 fclose(fp2);
tomoya123 0:9a52d95a79f7 1309 #endif
tomoya123 0:9a52d95a79f7 1310
tomoya123 0:9a52d95a79f7 1311 }