mirror of
https://github.com/supleed2/ELEC50003-P1-CW.git
synced 2024-09-19 20:16:16 +00:00
Add nonblock flag to UART FILE*
This commit is contained in:
parent
7ab9de2cc7
commit
108f4d1495
|
|
@ -1,5 +1,3 @@
|
||||||
|
|
||||||
|
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
#include "I2C_core.h"
|
#include "I2C_core.h"
|
||||||
#include "terasic_includes.h"
|
#include "terasic_includes.h"
|
||||||
|
|
@ -12,7 +10,7 @@
|
||||||
#include <unistd.h>
|
#include <unistd.h>
|
||||||
|
|
||||||
//EEE_IMGPROC defines
|
//EEE_IMGPROC defines
|
||||||
#define EEE_IMGPROC_MSG_START ('R'<<16 | 'B'<<8 | 'B')
|
#define EEE_IMGPROC_MSG_START ('R' << 16 | 'B' << 8 | 'B')
|
||||||
|
|
||||||
//offsets
|
//offsets
|
||||||
#define EEE_IMGPROC_STATUS 0
|
#define EEE_IMGPROC_STATUS 0
|
||||||
|
|
@ -26,286 +24,242 @@
|
||||||
#define GAIN_STEP 0x040
|
#define GAIN_STEP 0x040
|
||||||
#define DEFAULT_LEVEL 3
|
#define DEFAULT_LEVEL 3
|
||||||
|
|
||||||
#define MIPI_REG_PHYClkCtl 0x0056
|
#define MIPI_REG_PHYClkCtl 0x0056
|
||||||
#define MIPI_REG_PHYData0Ctl 0x0058
|
#define MIPI_REG_PHYData0Ctl 0x0058
|
||||||
#define MIPI_REG_PHYData1Ctl 0x005A
|
#define MIPI_REG_PHYData1Ctl 0x005A
|
||||||
#define MIPI_REG_PHYData2Ctl 0x005C
|
#define MIPI_REG_PHYData2Ctl 0x005C
|
||||||
#define MIPI_REG_PHYData3Ctl 0x005E
|
#define MIPI_REG_PHYData3Ctl 0x005E
|
||||||
#define MIPI_REG_PHYTimDly 0x0060
|
#define MIPI_REG_PHYTimDly 0x0060
|
||||||
#define MIPI_REG_PHYSta 0x0062
|
#define MIPI_REG_PHYSta 0x0062
|
||||||
#define MIPI_REG_CSIStatus 0x0064
|
#define MIPI_REG_CSIStatus 0x0064
|
||||||
#define MIPI_REG_CSIErrEn 0x0066
|
#define MIPI_REG_CSIErrEn 0x0066
|
||||||
#define MIPI_REG_MDLSynErr 0x0068
|
#define MIPI_REG_MDLSynErr 0x0068
|
||||||
#define MIPI_REG_FrmErrCnt 0x0080
|
#define MIPI_REG_FrmErrCnt 0x0080
|
||||||
#define MIPI_REG_MDLErrCnt 0x0090
|
#define MIPI_REG_MDLErrCnt 0x0090
|
||||||
|
|
||||||
void mipi_clear_error(void){
|
void mipi_clear_error(void)
|
||||||
MipiBridgeRegWrite(MIPI_REG_CSIStatus,0x01FF); // clear error
|
{
|
||||||
MipiBridgeRegWrite(MIPI_REG_MDLSynErr,0x0000); // clear error
|
MipiBridgeRegWrite(MIPI_REG_CSIStatus, 0x01FF); // clear error
|
||||||
MipiBridgeRegWrite(MIPI_REG_FrmErrCnt,0x0000); // clear error
|
MipiBridgeRegWrite(MIPI_REG_MDLSynErr, 0x0000); // clear error
|
||||||
MipiBridgeRegWrite(MIPI_REG_MDLErrCnt, 0x0000); // clear error
|
MipiBridgeRegWrite(MIPI_REG_FrmErrCnt, 0x0000); // clear error
|
||||||
|
MipiBridgeRegWrite(MIPI_REG_MDLErrCnt, 0x0000); // clear error
|
||||||
|
|
||||||
MipiBridgeRegWrite(0x0082,0x00);
|
MipiBridgeRegWrite(0x0082, 0x00);
|
||||||
MipiBridgeRegWrite(0x0084,0x00);
|
MipiBridgeRegWrite(0x0084, 0x00);
|
||||||
MipiBridgeRegWrite(0x0086,0x00);
|
MipiBridgeRegWrite(0x0086, 0x00);
|
||||||
MipiBridgeRegWrite(0x0088,0x00);
|
MipiBridgeRegWrite(0x0088, 0x00);
|
||||||
MipiBridgeRegWrite(0x008A,0x00);
|
MipiBridgeRegWrite(0x008A, 0x00);
|
||||||
MipiBridgeRegWrite(0x008C,0x00);
|
MipiBridgeRegWrite(0x008C, 0x00);
|
||||||
MipiBridgeRegWrite(0x008E,0x00);
|
MipiBridgeRegWrite(0x008E, 0x00);
|
||||||
MipiBridgeRegWrite(0x0090,0x00);
|
MipiBridgeRegWrite(0x0090, 0x00);
|
||||||
}
|
}
|
||||||
|
|
||||||
void mipi_show_error_info(void){
|
void mipi_show_error_info(void)
|
||||||
|
{
|
||||||
|
|
||||||
alt_u16 PHY_status, SCI_status, MDLSynErr, FrmErrCnt, MDLErrCnt;
|
alt_u16 PHY_status, SCI_status, MDLSynErr, FrmErrCnt, MDLErrCnt;
|
||||||
|
|
||||||
PHY_status = MipiBridgeRegRead(MIPI_REG_PHYSta);
|
PHY_status = MipiBridgeRegRead(MIPI_REG_PHYSta);
|
||||||
SCI_status = MipiBridgeRegRead(MIPI_REG_CSIStatus);
|
SCI_status = MipiBridgeRegRead(MIPI_REG_CSIStatus);
|
||||||
MDLSynErr = MipiBridgeRegRead(MIPI_REG_MDLSynErr);
|
MDLSynErr = MipiBridgeRegRead(MIPI_REG_MDLSynErr);
|
||||||
FrmErrCnt = MipiBridgeRegRead(MIPI_REG_FrmErrCnt);
|
FrmErrCnt = MipiBridgeRegRead(MIPI_REG_FrmErrCnt);
|
||||||
MDLErrCnt = MipiBridgeRegRead(MIPI_REG_MDLErrCnt);
|
MDLErrCnt = MipiBridgeRegRead(MIPI_REG_MDLErrCnt);
|
||||||
printf("PHY_status=%xh, CSI_status=%xh, MDLSynErr=%xh, FrmErrCnt=%xh, MDLErrCnt=%xh\r\n", PHY_status, SCI_status, MDLSynErr,FrmErrCnt, MDLErrCnt);
|
printf("PHY_status=%xh, CSI_status=%xh, MDLSynErr=%xh, FrmErrCnt=%xh, MDLErrCnt=%xh\r\n", PHY_status, SCI_status, MDLSynErr, FrmErrCnt, MDLErrCnt);
|
||||||
}
|
}
|
||||||
|
|
||||||
void mipi_show_error_info_more(void){
|
void mipi_show_error_info_more(void)
|
||||||
printf("FrmErrCnt = %d\n",MipiBridgeRegRead(0x0080));
|
{
|
||||||
printf("CRCErrCnt = %d\n",MipiBridgeRegRead(0x0082));
|
printf("FrmErrCnt = %d\n", MipiBridgeRegRead(0x0080));
|
||||||
printf("CorErrCnt = %d\n",MipiBridgeRegRead(0x0084));
|
printf("CRCErrCnt = %d\n", MipiBridgeRegRead(0x0082));
|
||||||
printf("HdrErrCnt = %d\n",MipiBridgeRegRead(0x0086));
|
printf("CorErrCnt = %d\n", MipiBridgeRegRead(0x0084));
|
||||||
printf("EIDErrCnt = %d\n",MipiBridgeRegRead(0x0088));
|
printf("HdrErrCnt = %d\n", MipiBridgeRegRead(0x0086));
|
||||||
printf("CtlErrCnt = %d\n",MipiBridgeRegRead(0x008A));
|
printf("EIDErrCnt = %d\n", MipiBridgeRegRead(0x0088));
|
||||||
printf("SoTErrCnt = %d\n",MipiBridgeRegRead(0x008C));
|
printf("CtlErrCnt = %d\n", MipiBridgeRegRead(0x008A));
|
||||||
printf("SynErrCnt = %d\n",MipiBridgeRegRead(0x008E));
|
printf("SoTErrCnt = %d\n", MipiBridgeRegRead(0x008C));
|
||||||
printf("MDLErrCnt = %d\n",MipiBridgeRegRead(0x0090));
|
printf("SynErrCnt = %d\n", MipiBridgeRegRead(0x008E));
|
||||||
printf("FIFOSTATUS = %d\n",MipiBridgeRegRead(0x00F8));
|
printf("MDLErrCnt = %d\n", MipiBridgeRegRead(0x0090));
|
||||||
printf("DataType = 0x%04x\n",MipiBridgeRegRead(0x006A));
|
printf("FIFOSTATUS = %d\n", MipiBridgeRegRead(0x00F8));
|
||||||
printf("CSIPktLen = %d\n",MipiBridgeRegRead(0x006E));
|
printf("DataType = 0x%04x\n", MipiBridgeRegRead(0x006A));
|
||||||
|
printf("CSIPktLen = %d\n", MipiBridgeRegRead(0x006E));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
bool MIPI_Init(void)
|
||||||
|
{
|
||||||
|
bool bSuccess;
|
||||||
|
|
||||||
|
bSuccess = oc_i2c_init_ex(I2C_OPENCORES_MIPI_BASE, 50 * 1000 * 1000, 400 * 1000); //I2C: 400K
|
||||||
|
if (!bSuccess)
|
||||||
|
{
|
||||||
|
printf("failed to init MIPI- Bridge i2c\r\n");
|
||||||
|
}
|
||||||
|
|
||||||
bool MIPI_Init(void){
|
usleep(50 * 1000);
|
||||||
bool bSuccess;
|
|
||||||
|
|
||||||
|
|
||||||
bSuccess = oc_i2c_init_ex(I2C_OPENCORES_MIPI_BASE, 50*1000*1000,400*1000); //I2C: 400K
|
|
||||||
if (!bSuccess)
|
|
||||||
printf("failed to init MIPI- Bridge i2c\r\n");
|
|
||||||
|
|
||||||
usleep(50*1000);
|
|
||||||
MipiBridgeInit();
|
MipiBridgeInit();
|
||||||
|
|
||||||
usleep(500*1000);
|
usleep(500 * 1000);
|
||||||
|
|
||||||
// bSuccess = oc_i2c_init_ex(I2C_OPENCORES_CAMERA_BASE, 50*1000*1000,400*1000); //I2C: 400K
|
|
||||||
// if (!bSuccess)
|
|
||||||
// printf("failed to init MIPI- Camera i2c\r\n");
|
|
||||||
|
|
||||||
MipiCameraInit();
|
MipiCameraInit();
|
||||||
MIPI_BIN_LEVEL(DEFAULT_LEVEL);
|
MIPI_BIN_LEVEL(DEFAULT_LEVEL);
|
||||||
// OV8865_FOCUS_Move_to(340);
|
|
||||||
|
|
||||||
// oc_i2c_uninit(I2C_OPENCORES_CAMERA_BASE); // Release I2C bus , due to two I2C master shared!
|
usleep(1000);
|
||||||
|
|
||||||
|
return bSuccess;
|
||||||
usleep(1000);
|
|
||||||
|
|
||||||
|
|
||||||
// oc_i2c_uninit(I2C_OPENCORES_MIPI_BASE);
|
|
||||||
|
|
||||||
return bSuccess;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
int main()
|
int main()
|
||||||
{
|
{
|
||||||
|
fcntl(STDIN_FILENO, F_SETFL, O_NONBLOCK);
|
||||||
|
|
||||||
fcntl(STDIN_FILENO, F_SETFL, O_NONBLOCK);
|
printf("DE10-LITE D8M VGA Demo\n");
|
||||||
|
printf("Imperial College EEE2 Project version\n");
|
||||||
printf("DE10-LITE D8M VGA Demo\n");
|
IOWR(MIPI_PWDN_N_BASE, 0x00, 0x00);
|
||||||
printf("Imperial College EEE2 Project version\n");
|
IOWR(MIPI_RESET_N_BASE, 0x00, 0x00);
|
||||||
IOWR(MIPI_PWDN_N_BASE, 0x00, 0x00);
|
|
||||||
IOWR(MIPI_RESET_N_BASE, 0x00, 0x00);
|
|
||||||
|
|
||||||
usleep(2000);
|
|
||||||
IOWR(MIPI_PWDN_N_BASE, 0x00, 0xFF);
|
|
||||||
usleep(2000);
|
|
||||||
IOWR(MIPI_RESET_N_BASE, 0x00, 0xFF);
|
|
||||||
|
|
||||||
printf("Image Processor ID: %x\n",IORD(0x42000,EEE_IMGPROC_ID));
|
|
||||||
//printf("Image Processor ID: %x\n",IORD(EEE_IMGPROC_0_BASE,EEE_IMGPROC_ID)); //Don't know why this doesn't work - definition is in system.h in BSP
|
|
||||||
|
|
||||||
|
|
||||||
usleep(2000);
|
|
||||||
|
|
||||||
|
|
||||||
// MIPI Init
|
|
||||||
if (!MIPI_Init()){
|
|
||||||
printf("MIPI_Init Init failed!\r\n");
|
|
||||||
}else{
|
|
||||||
printf("MIPI_Init Init successfully!\r\n");
|
|
||||||
}
|
|
||||||
|
|
||||||
// while(1){
|
|
||||||
mipi_clear_error();
|
|
||||||
usleep(50*1000);
|
|
||||||
mipi_clear_error();
|
|
||||||
usleep(1000*1000);
|
|
||||||
mipi_show_error_info();
|
|
||||||
// mipi_show_error_info_more();
|
|
||||||
printf("\n");
|
|
||||||
// }
|
|
||||||
|
|
||||||
|
|
||||||
#if 0 // focus sweep
|
|
||||||
printf("\nFocus sweep\n");
|
|
||||||
alt_u16 ii= 350;
|
|
||||||
alt_u8 dir = 0;
|
|
||||||
while(1){
|
|
||||||
if(ii< 50) dir = 1;
|
|
||||||
else if (ii> 1000) dir =0;
|
|
||||||
|
|
||||||
if(dir) ii += 20;
|
|
||||||
else ii -= 20;
|
|
||||||
|
|
||||||
printf("%d\n",ii);
|
|
||||||
OV8865_FOCUS_Move_to(ii);
|
|
||||||
usleep(50*1000);
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
|
usleep(2000);
|
||||||
|
IOWR(MIPI_PWDN_N_BASE, 0x00, 0xFF);
|
||||||
|
usleep(2000);
|
||||||
|
IOWR(MIPI_RESET_N_BASE, 0x00, 0xFF);
|
||||||
|
|
||||||
|
printf("Image Processor ID: %x\n", IORD(0x42000, EEE_IMGPROC_ID));
|
||||||
|
//printf("Image Processor ID: %x\n",IORD(EEE_IMGPROC_0_BASE,EEE_IMGPROC_ID)); //Don't know why this doesn't work - definition is in system.h in BSP
|
||||||
|
|
||||||
|
usleep(2000);
|
||||||
|
|
||||||
|
// MIPI Init
|
||||||
|
if (!MIPI_Init())
|
||||||
|
{
|
||||||
|
printf("MIPI_Init Init failed!\r\n");
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
printf("MIPI_Init Init successfully!\r\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
// while(1){
|
||||||
|
mipi_clear_error();
|
||||||
|
usleep(50 * 1000);
|
||||||
|
mipi_clear_error();
|
||||||
|
usleep(1000 * 1000);
|
||||||
|
mipi_show_error_info();
|
||||||
|
// mipi_show_error_info_more();
|
||||||
|
printf("\n");
|
||||||
|
// }
|
||||||
|
|
||||||
//////////////////////////////////////////////////////////
|
//////////////////////////////////////////////////////////
|
||||||
alt_u16 bin_level = DEFAULT_LEVEL;
|
alt_u16 bin_level = DEFAULT_LEVEL;
|
||||||
alt_u8 manual_focus_step = 10;
|
alt_u8 manual_focus_step = 10;
|
||||||
alt_u16 current_focus = 300;
|
alt_u16 current_focus = 300;
|
||||||
int boundingBoxColour = 0;
|
int boundingBoxColour = 0;
|
||||||
alt_u32 exposureTime = EXPOSURE_INIT;
|
alt_u32 exposureTime = EXPOSURE_INIT;
|
||||||
alt_u16 gain = GAIN_INIT;
|
alt_u16 gain = GAIN_INIT;
|
||||||
|
|
||||||
OV8865SetExposure(exposureTime);
|
OV8865SetExposure(exposureTime);
|
||||||
OV8865SetGain(gain);
|
OV8865SetGain(gain);
|
||||||
Focus_Init();
|
Focus_Init();
|
||||||
|
|
||||||
FILE* ser = fopen("/dev/uart_0", "rb+");
|
FILE *ser = fopen("/dev/uart_0", "rb+");
|
||||||
if(ser){
|
fcntl(ser, F_SETFL, O_NONBLOCK);
|
||||||
printf("Opened UART\n");
|
if (ser)
|
||||||
} else {
|
{
|
||||||
printf("Failed to open UART\n");
|
printf("Opened UART\n");
|
||||||
while (1);
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
printf("Failed to open UART\n");
|
||||||
|
while (1)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
while (1)
|
||||||
|
{
|
||||||
|
|
||||||
|
// touch KEY0 to trigger Auto focus
|
||||||
|
if ((IORD(KEY_BASE, 0) & 0x03) == 0x02)
|
||||||
|
{
|
||||||
|
|
||||||
|
current_focus = Focus_Window(320, 240);
|
||||||
|
}
|
||||||
|
// touch KEY1 to ZOOM
|
||||||
|
if ((IORD(KEY_BASE, 0) & 0x03) == 0x01)
|
||||||
|
{
|
||||||
|
if (bin_level == 3)
|
||||||
|
bin_level = 1;
|
||||||
|
else
|
||||||
|
bin_level++;
|
||||||
|
printf("set bin level to %d\n", bin_level);
|
||||||
|
MIPI_BIN_LEVEL(bin_level);
|
||||||
|
usleep(500000);
|
||||||
}
|
}
|
||||||
|
|
||||||
while(1){
|
//Read messages from the image processor and print them on the terminal
|
||||||
|
while ((IORD(0x42000, EEE_IMGPROC_STATUS) >> 8) & 0xff)
|
||||||
|
{ //Find out if there are words to read
|
||||||
|
int word = IORD(0x42000, EEE_IMGPROC_MSG); //Get next word from message buffer
|
||||||
|
if (fwrite(&word, 4, 1, ser) != 1)
|
||||||
|
printf("Error writing to UART");
|
||||||
|
if (word == EEE_IMGPROC_MSG_START) //Newline on message identifier
|
||||||
|
printf("\n");
|
||||||
|
printf("%08x ", word);
|
||||||
|
}
|
||||||
|
|
||||||
// touch KEY0 to trigger Auto focus
|
//Update the bounding box colour
|
||||||
if((IORD(KEY_BASE,0)&0x03) == 0x02){
|
boundingBoxColour = ((boundingBoxColour + 1) & 0xff);
|
||||||
|
IOWR(0x42000, EEE_IMGPROC_BBCOL, (boundingBoxColour << 8) | (0xff - boundingBoxColour));
|
||||||
|
|
||||||
current_focus = Focus_Window(320,240);
|
//Process input commands
|
||||||
}
|
int in = getchar();
|
||||||
// touch KEY1 to ZOOM
|
switch (in)
|
||||||
if((IORD(KEY_BASE,0)&0x03) == 0x01){
|
{
|
||||||
if(bin_level == 3 )bin_level = 1;
|
case 'e':
|
||||||
else bin_level ++;
|
{
|
||||||
printf("set bin level to %d\n",bin_level);
|
exposureTime += EXPOSURE_STEP;
|
||||||
MIPI_BIN_LEVEL(bin_level);
|
OV8865SetExposure(exposureTime);
|
||||||
usleep(500000);
|
printf("\nExposure = %x ", exposureTime);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
case 'd':
|
||||||
|
{
|
||||||
|
exposureTime -= EXPOSURE_STEP;
|
||||||
|
OV8865SetExposure(exposureTime);
|
||||||
|
printf("\nExposure = %x ", exposureTime);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
case 't':
|
||||||
|
{
|
||||||
|
gain += GAIN_STEP;
|
||||||
|
OV8865SetGain(gain);
|
||||||
|
printf("\nGain = %x ", gain);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
case 'g':
|
||||||
|
{
|
||||||
|
gain -= GAIN_STEP;
|
||||||
|
OV8865SetGain(gain);
|
||||||
|
printf("\nGain = %x ", gain);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
case 'r':
|
||||||
|
{
|
||||||
|
current_focus += manual_focus_step;
|
||||||
|
if (current_focus > 1023)
|
||||||
|
current_focus = 1023;
|
||||||
|
OV8865_FOCUS_Move_to(current_focus);
|
||||||
|
printf("\nFocus = %x ", current_focus);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
case 'f':
|
||||||
|
{
|
||||||
|
if (current_focus > manual_focus_step)
|
||||||
|
current_focus -= manual_focus_step;
|
||||||
|
OV8865_FOCUS_Move_to(current_focus);
|
||||||
|
printf("\nFocus = %x ", current_focus);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
}
|
//Main loop delay
|
||||||
|
usleep(10000);
|
||||||
|
};
|
||||||
#if 0
|
return 0;
|
||||||
if((IORD(KEY_BASE,0)&0x0F) == 0x0E){
|
|
||||||
|
|
||||||
current_focus = Focus_Window(320,240);
|
|
||||||
}
|
|
||||||
|
|
||||||
// touch KEY1 to trigger Manual focus - step
|
|
||||||
if((IORD(KEY_BASE,0)&0x0F) == 0x0D){
|
|
||||||
|
|
||||||
if(current_focus > manual_focus_step) current_focus -= manual_focus_step;
|
|
||||||
else current_focus = 0;
|
|
||||||
OV8865_FOCUS_Move_to(current_focus);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
// touch KEY2 to trigger Manual focus + step
|
|
||||||
if((IORD(KEY_BASE,0)&0x0F) == 0x0B){
|
|
||||||
current_focus += manual_focus_step;
|
|
||||||
if(current_focus >1023) current_focus = 1023;
|
|
||||||
OV8865_FOCUS_Move_to(current_focus);
|
|
||||||
}
|
|
||||||
|
|
||||||
// touch KEY3 to ZOOM
|
|
||||||
if((IORD(KEY_BASE,0)&0x0F) == 0x07){
|
|
||||||
if(bin_level == 3 )bin_level = 1;
|
|
||||||
else bin_level ++;
|
|
||||||
printf("set bin level to %d\n",bin_level);
|
|
||||||
MIPI_BIN_LEVEL(bin_level);
|
|
||||||
usleep(500000);
|
|
||||||
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
//Read messages from the image processor and print them on the terminal
|
|
||||||
while ((IORD(0x42000,EEE_IMGPROC_STATUS)>>8) & 0xff) { //Find out if there are words to read
|
|
||||||
int word = IORD(0x42000,EEE_IMGPROC_MSG); //Get next word from message buffer
|
|
||||||
if (fwrite(&word, 4, 1, ser) != 1)
|
|
||||||
printf("Error writing to UART");
|
|
||||||
if (word == EEE_IMGPROC_MSG_START) //Newline on message identifier
|
|
||||||
printf("\n");
|
|
||||||
printf("%08x ",word);
|
|
||||||
}
|
|
||||||
|
|
||||||
//Update the bounding box colour
|
|
||||||
boundingBoxColour = ((boundingBoxColour + 1) & 0xff);
|
|
||||||
IOWR(0x42000, EEE_IMGPROC_BBCOL, (boundingBoxColour << 8) | (0xff - boundingBoxColour));
|
|
||||||
|
|
||||||
//Process input commands
|
|
||||||
int in = getchar();
|
|
||||||
switch (in) {
|
|
||||||
case 'e': {
|
|
||||||
exposureTime += EXPOSURE_STEP;
|
|
||||||
OV8865SetExposure(exposureTime);
|
|
||||||
printf("\nExposure = %x ", exposureTime);
|
|
||||||
break;}
|
|
||||||
case 'd': {
|
|
||||||
exposureTime -= EXPOSURE_STEP;
|
|
||||||
OV8865SetExposure(exposureTime);
|
|
||||||
printf("\nExposure = %x ", exposureTime);
|
|
||||||
break;}
|
|
||||||
case 't': {
|
|
||||||
gain += GAIN_STEP;
|
|
||||||
OV8865SetGain(gain);
|
|
||||||
printf("\nGain = %x ", gain);
|
|
||||||
break;}
|
|
||||||
case 'g': {
|
|
||||||
gain -= GAIN_STEP;
|
|
||||||
OV8865SetGain(gain);
|
|
||||||
printf("\nGain = %x ", gain);
|
|
||||||
break;}
|
|
||||||
case 'r': {
|
|
||||||
current_focus += manual_focus_step;
|
|
||||||
if(current_focus >1023) current_focus = 1023;
|
|
||||||
OV8865_FOCUS_Move_to(current_focus);
|
|
||||||
printf("\nFocus = %x ",current_focus);
|
|
||||||
break;}
|
|
||||||
case 'f': {
|
|
||||||
if(current_focus > manual_focus_step) current_focus -= manual_focus_step;
|
|
||||||
OV8865_FOCUS_Move_to(current_focus);
|
|
||||||
printf("\nFocus = %x ",current_focus);
|
|
||||||
break;}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
//Main loop delay
|
|
||||||
usleep(10000);
|
|
||||||
|
|
||||||
};
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue