gammaedit.c

#include "TFT.h"
#include "captureimage.h"
#include "config.h"
#include "twicam.h"
#include "camregdef.h"
#include <stdint.h>
#include <util/delay.h>
#ifndef MT9D111
static uint8_t point=0;
static inline void graph(uint8_t y,uint8_t x,uint16_t col){
	y=y*15/32;
	tft_setXY(239-y,319-x);
	tft_sendData(col);
}
static inline uint16_t pickSel(uint8_t sel){
		return sel==point ? RED:WHITE;
}
static void redrawGraph(void){
	#ifdef ov7670
		graph(rdReg(0x7b),2,pickSel(0));
		graph(rdReg(0x7c),4,pickSel(1));
		graph(rdReg(0x7d),8,pickSel(2));
		graph(rdReg(0x7e),15,pickSel(3));
		graph(rdReg(0x7f),19,pickSel(4));
		graph(rdReg(0x80),23,pickSel(5));
		graph(rdReg(0x81),26,pickSel(6));
		graph(rdReg(0x82),30,pickSel(7));
		graph(rdReg(0x83),34,pickSel(8));
		graph(rdReg(0x84),38,pickSel(9));
		graph(rdReg(0x85),45,pickSel(10));
		graph(rdReg(0x86),53,pickSel(11));
		graph(rdReg(0x87),68,pickSel(12));
		graph(rdReg(0x88),83,pickSel(13));
		graph(rdReg(0x89),98,pickSel(14));
		graph(256-(rdReg(0x7A)*3/4),120,GREEN);
	#elif defined ov7740
		graph(rdReg(0x9C),2,pickSel(0));
		graph(rdReg(0x9D),4,pickSel(1));
		graph(rdReg(0x9E),8,pickSel(2));
		graph(rdReg(0x9F),15,pickSel(3));
		graph(rdReg(0xA0),19,pickSel(4));
		graph(rdReg(0xA1),23,pickSel(5));
		graph(rdReg(0xA2),26,pickSel(6));
		graph(rdReg(0xA3),30,pickSel(7));
		graph(rdReg(0xA4),34,pickSel(8));
		graph(rdReg(0xA5),38,pickSel(9));
		graph(rdReg(0xA6),45,pickSel(10));
		graph(rdReg(0xA7),53,pickSel(11));
		graph(rdReg(0xA8),68,pickSel(12));
		graph(rdReg(0xA9),83,pickSel(13));
		graph(rdReg(0xAA),98,pickSel(14));
		graph(256-(rdReg(0xA8)*3/4),120,GREEN);
	#endif
}
#endif
void gammaEdit(void){
	uint16_t x,y,z;
	setColor(RGB565);
	setRes(QQVGA);
	#ifdef MT9D111
		MT9D111Refresh();
	#endif
	tft_paintScreenBlack();
	#ifdef MT9D111
		return;
	#else
		do{
			getPoint(&x,&y,&z);
			tft_setOrientation(1);
			#ifdef ov7670
				wrReg(REG_COM13, COM13_UVSAT|COM13_RSVD);
			#elif defined ov7740
				wrReg(ISP_CTRL00,rdReg(ISP_CTRL00)&(~ISP_CTRL00_gamma));
			#endif
			capImgqqvga(160);
			#ifdef ov7670
				wrReg(REG_COM13, COM13_GAMMA|COM13_UVSAT|COM13_RSVD);
			#elif defined ov7740
				wrReg(ISP_CTRL00,rdReg(ISP_CTRL00)|ISP_CTRL00_gamma);
			#endif
			capImgqqvga(0);
			tft_setDisplayDirect(DOWN2UP);
			redrawGraph();
		}while(z<10);
		setRes(QVGA);
	#endif
}