summaryrefslogtreecommitdiff
path: root/fw/fe310/eos/i2c
diff options
context:
space:
mode:
authorUros Majstorovic <majstor@majstor.org>2022-05-13 12:45:53 +0200
committerUros Majstorovic <majstor@majstor.org>2022-05-13 12:45:53 +0200
commit412a8f99928beff605805807b0f07f6bf8d0a965 (patch)
tree366f1768ddfd32960c5d26ca3fba14e82c3b571e /fw/fe310/eos/i2c
parent9ccb4db8d59ec9dab33ee8617d462f21a8bb4fa8 (diff)
code rename
Diffstat (limited to 'fw/fe310/eos/i2c')
-rw-r--r--fw/fe310/eos/i2c/Makefile16
-rw-r--r--fw/fe310/eos/i2c/bq25895.c43
-rw-r--r--fw/fe310/eos/i2c/bq25895.h5
-rw-r--r--fw/fe310/eos/i2c/drv2605.h3
-rw-r--r--fw/fe310/eos/i2c/lsm9ds1.h4
-rw-r--r--fw/fe310/eos/i2c/ov2640.c861
-rw-r--r--fw/fe310/eos/i2c/ov2640.h8
-rw-r--r--fw/fe310/eos/i2c/ov2640_regs.h245
8 files changed, 0 insertions, 1185 deletions
diff --git a/fw/fe310/eos/i2c/Makefile b/fw/fe310/eos/i2c/Makefile
deleted file mode 100644
index 83cb1f5..0000000
--- a/fw/fe310/eos/i2c/Makefile
+++ /dev/null
@@ -1,16 +0,0 @@
-include ../../common.mk
-CFLAGS += -I$(bsp_dir)/include
-
-obj = bq25895.o ov2640.o gt911.o
-
-
-%.o: %.c %.h
- $(CC) $(CFLAGS) -c $<
-
-%.o: %.S
- $(CC) $(CFLAGS) -c $<
-
-all: $(obj)
-
-clean:
- rm -f *.o
diff --git a/fw/fe310/eos/i2c/bq25895.c b/fw/fe310/eos/i2c/bq25895.c
deleted file mode 100644
index b290926..0000000
--- a/fw/fe310/eos/i2c/bq25895.c
+++ /dev/null
@@ -1,43 +0,0 @@
-#include <stdlib.h>
-#include <stdint.h>
-#include <stdio.h>
-
-#include "eos.h"
-#include "pwr.h"
-#include "i2c.h"
-#include "bq25895.h"
-
-static int reg_read(uint8_t reg, uint8_t *data) {
- return eos_i2c_read8(BQ25895_ADDR, reg, data, 1);
-}
-
-static int reg_write(uint8_t reg, uint8_t data) {
- return eos_i2c_write8(BQ25895_ADDR, reg, &data, 1);
-}
-
-int eos_bq25895_init(uint8_t wakeup_cause) {
- int rst = (wakeup_cause == EOS_PWR_WAKE_RST);
- int i, rv = EOS_OK;
- uint8_t data = 0;
-
- if (rst) {
- rv = reg_write(0x14, 0x80); // reset
- if (rv) printf("I2C ERROR 0x14\n");
- rv = reg_write(0x14, 0x00); // disable watchdog
- if (rv) printf("I2C ERROR 0x14\n");
- rv = reg_write(0x07, 0x8d); // disable watchdog
- if (rv) printf("I2C ERROR 0x07\n");
- rv = reg_write(0x00, 0x28); // 2.1A input current
- if (rv) printf("I2C ERROR 0x00\n");
- rv = reg_write(0x02, 0x30); // enable ICO, disaable MaxCharge and D+/D-
- if (rv) printf("I2C ERROR 0x02\n");
- }
-
- printf("BQ25895:\n");
- for (i=0; i<0x15; i++) {
- rv = reg_read(i, &data);
- if (!rv) printf("REG%02x: %02x\n", i, data);
- }
-
- return EOS_OK;
-}
diff --git a/fw/fe310/eos/i2c/bq25895.h b/fw/fe310/eos/i2c/bq25895.h
deleted file mode 100644
index cbef36e..0000000
--- a/fw/fe310/eos/i2c/bq25895.h
+++ /dev/null
@@ -1,5 +0,0 @@
-#include <stdint.h>
-
-#define BQ25895_ADDR 0x6A
-
-int eos_bq25895_init(uint8_t wakeup_cause);
diff --git a/fw/fe310/eos/i2c/drv2605.h b/fw/fe310/eos/i2c/drv2605.h
deleted file mode 100644
index fe90a9b..0000000
--- a/fw/fe310/eos/i2c/drv2605.h
+++ /dev/null
@@ -1,3 +0,0 @@
-#include <stdint.h>
-
-#define DRV2605_ADDR 0x5A
diff --git a/fw/fe310/eos/i2c/lsm9ds1.h b/fw/fe310/eos/i2c/lsm9ds1.h
deleted file mode 100644
index 92220e7..0000000
--- a/fw/fe310/eos/i2c/lsm9ds1.h
+++ /dev/null
@@ -1,4 +0,0 @@
-#include <stdint.h>
-
-#define LSM9DS1_ADDR_AG 0x1E
-#define LSM9DS1_ADDR_M 0x6B
diff --git a/fw/fe310/eos/i2c/ov2640.c b/fw/fe310/eos/i2c/ov2640.c
deleted file mode 100644
index 6e54f10..0000000
--- a/fw/fe310/eos/i2c/ov2640.c
+++ /dev/null
@@ -1,861 +0,0 @@
-#include <stdlib.h>
-#include <stdint.h>
-#include <math.h>
-
-#include "eos.h"
-#include "timer.h"
-#include "cam.h"
-
-#include "i2c.h"
-#include "ov2640_regs.h"
-#include "ov2640.h"
-
-#define XCLK_FREQ 24000000
-//#define XCLK_FREQ 12000000
-
-#define CIF_WIDTH (400)
-#define CIF_HEIGHT (296)
-
-#define SVGA_WIDTH (800)
-#define SVGA_HEIGHT (600)
-
-#define UXGA_WIDTH (1600)
-#define UXGA_HEIGHT (1200)
-
-static const uint8_t default_regs[][2] = {
-
-// From Linux Driver.
-
- {BANK_SEL, BANK_SEL_DSP},
- {0x2c, 0xff},
- {0x2e, 0xdf},
- {BANK_SEL, BANK_SEL_SENSOR},
- {0x3c, 0x32},
-// {CLKRC, CLKRC_DOUBLE | 0x02},
- {CLKRC, 0x01},
- {COM2, COM2_OUT_DRIVE_3x},
- {REG04, REG04_SET(REG04_HFLIP_IMG | REG04_VFLIP_IMG | REG04_VREF_EN | REG04_HREF_EN)},
- {COM8, COM8_SET(COM8_BNDF_EN | COM8_AGC_EN | COM8_AEC_EN)},
- {COM9, COM9_AGC_SET(COM9_AGC_GAIN_8x)},
- {0x2c, 0x0c},
- {0x33, 0x78},
- {0x3a, 0x33},
- {0x3b, 0xfb},
- {0x3e, 0x00},
- {0x43, 0x11},
- {0x16, 0x10},
- {0x39, 0x02},
- {0x35, 0x88},
- {0x22, 0x0a},
- {0x37, 0x40},
- {0x23, 0x00},
- {ARCOM2, 0xa0},
- {0x06, 0x02},
- {0x06, 0x88},
- {0x07, 0xc0},
- {0x0d, 0xb7},
- {0x0e, 0x01},
- {0x4c, 0x00},
- {0x4a, 0x81},
- {0x21, 0x99},
- {AEW, 0x40},
- {AEB, 0x38},
- {VV, VV_AGC_TH_SET(0x08, 0x02)},
- {0x5c, 0x00},
- {0x63, 0x00},
- {FLL, 0x22},
- {COM3, COM3_BAND_SET(COM3_BAND_AUTO)},
- {REG5D, 0x55},
- {REG5E, 0x7d},
- {REG5F, 0x7d},
- {REG60, 0x55},
- {HISTO_LOW, 0x70},
- {HISTO_HIGH, 0x80},
- {0x7c, 0x05},
- {0x20, 0x80},
- {0x28, 0x30},
- {0x6c, 0x00},
- {0x6d, 0x80},
- {0x6e, 0x00},
- {0x70, 0x02},
- {0x71, 0x94},
- {0x73, 0xc1},
- {0x3d, 0x34},
- {COM7, COM7_RES_UXGA | COM7_ZOOM_EN},
- {0x5a, 0x57},
- {COM25, 0x00},
- {BD50, 0xbb},
- {BD60, 0x9c},
- {BANK_SEL, BANK_SEL_DSP},
- {0xe5, 0x7f},
- {MC_BIST, MC_BIST_RESET | MC_BIST_BOOT_ROM_SEL},
- {0x41, 0x24},
- {RESET, RESET_JPEG | RESET_DVP},
- {0x76, 0xff},
- {0x33, 0xa0},
- {0x42, 0x20},
- {0x43, 0x18},
- {0x4c, 0x00},
- {CTRL3, CTRL3_BPC_EN | CTRL3_WPC_EN | 0x10},
- {0x88, 0x3f},
- {0xd7, 0x03},
- {0xd9, 0x10},
- {R_DVP_SP, R_DVP_SP_AUTO_MODE | 0x2},
- {0xc8, 0x08},
- {0xc9, 0x80},
- {BPADDR, 0x00},
- {BPDATA, 0x00},
- {BPADDR, 0x03},
- {BPDATA, 0x48},
- {BPDATA, 0x48},
- {BPADDR, 0x08},
- {BPDATA, 0x20},
- {BPDATA, 0x10},
- {BPDATA, 0x0e},
- {0x90, 0x00},
- {0x91, 0x0e},
- {0x91, 0x1a},
- {0x91, 0x31},
- {0x91, 0x5a},
- {0x91, 0x69},
- {0x91, 0x75},
- {0x91, 0x7e},
- {0x91, 0x88},
- {0x91, 0x8f},
- {0x91, 0x96},
- {0x91, 0xa3},
- {0x91, 0xaf},
- {0x91, 0xc4},
- {0x91, 0xd7},
- {0x91, 0xe8},
- {0x91, 0x20},
- {0x92, 0x00},
- {0x93, 0x06},
- {0x93, 0xe3},
- {0x93, 0x03},
- {0x93, 0x03},
- {0x93, 0x00},
- {0x93, 0x02},
- {0x93, 0x00},
- {0x93, 0x00},
- {0x93, 0x00},
- {0x93, 0x00},
- {0x93, 0x00},
- {0x93, 0x00},
- {0x93, 0x00},
- {0x96, 0x00},
- {0x97, 0x08},
- {0x97, 0x19},
- {0x97, 0x02},
- {0x97, 0x0c},
- {0x97, 0x24},
- {0x97, 0x30},
- {0x97, 0x28},
- {0x97, 0x26},
- {0x97, 0x02},
- {0x97, 0x98},
- {0x97, 0x80},
- {0x97, 0x00},
- {0x97, 0x00},
- {0xa4, 0x00},
- {0xa8, 0x00},
- {0xc5, 0x11},
- {0xc6, 0x51},
- {0xbf, 0x80},
- {0xc7, 0x10}, /* simple AWB */
- {0xb6, 0x66},
- {0xb8, 0xA5},
- {0xb7, 0x64},
- {0xb9, 0x7C},
- {0xb3, 0xaf},
- {0xb4, 0x97},
- {0xb5, 0xFF},
- {0xb0, 0xC5},
- {0xb1, 0x94},
- {0xb2, 0x0f},
- {0xc4, 0x5c},
- {0xa6, 0x00},
- {0xa7, 0x20},
- {0xa7, 0xd8},
- {0xa7, 0x1b},
- {0xa7, 0x31},
- {0xa7, 0x00},
- {0xa7, 0x18},
- {0xa7, 0x20},
- {0xa7, 0xd8},
- {0xa7, 0x19},
- {0xa7, 0x31},
- {0xa7, 0x00},
- {0xa7, 0x18},
- {0xa7, 0x20},
- {0xa7, 0xd8},
- {0xa7, 0x19},
- {0xa7, 0x31},
- {0xa7, 0x00},
- {0xa7, 0x18},
- {0x7f, 0x00},
- {0xe5, 0x1f},
- {0xe1, 0x77},
- {0xdd, 0x7f},
- {CTRL0, CTRL0_YUV422 | CTRL0_YUV_EN | CTRL0_RGB_EN},
-
-// OpenMV Custom.
-
- {BANK_SEL, BANK_SEL_SENSOR},
- {0x0f, 0x4b},
- {COM1, 0x8f},
-
-// End.
-
- {0xff, 0xff},
-};
-
-// Looks really bad.
-//static const uint8_t cif_regs[][2] = {
-// {BANK_SEL, BANK_SEL_SENSOR},
-// {COM7, COM7_RES_CIF},
-// {COM1, 0x06 | 0x80},
-// {HSTART, 0x11},
-// {HSTOP, 0x43},
-// {VSTART, 0x01}, // 0x01 fixes issue with garbage pixels in the image...
-// {VSTOP, 0x97},
-// {REG32, 0x09},
-// {BANK_SEL, BANK_SEL_DSP},
-// {RESET, RESET_DVP},
-// {SIZEL, SIZEL_HSIZE8_11_SET(CIF_WIDTH) | SIZEL_HSIZE8_SET(CIF_WIDTH) | SIZEL_VSIZE8_SET(CIF_HEIGHT)},
-// {HSIZE8, HSIZE8_SET(CIF_WIDTH)},
-// {VSIZE8, VSIZE8_SET(CIF_HEIGHT)},
-// {CTRL2, CTRL2_DCW_EN | CTRL2_SDE_EN | CTRL2_UV_AVG_EN | CTRL2_CMX_EN | CTRL2_UV_ADJ_EN},
-// {0, 0},
-//};
-
-static const uint8_t svga_regs[][2] = {
- {BANK_SEL, BANK_SEL_SENSOR},
- {COM7, COM7_RES_SVGA},
- {COM1, 0x0A | 0x80},
- {HSTART, 0x11},
- {HSTOP, 0x43},
- {VSTART, 0x01}, // 0x01 fixes issue with garbage pixels in the image...
- {VSTOP, 0x97},
- {REG32, 0x09},
- {BANK_SEL, BANK_SEL_DSP},
- {RESET, RESET_DVP},
- {SIZEL, SIZEL_HSIZE8_11_SET(SVGA_WIDTH) | SIZEL_HSIZE8_SET(SVGA_WIDTH) | SIZEL_VSIZE8_SET(SVGA_HEIGHT)},
- {HSIZE8, HSIZE8_SET(SVGA_WIDTH)},
- {VSIZE8, VSIZE8_SET(SVGA_HEIGHT)},
- {CTRL2, CTRL2_DCW_EN | CTRL2_SDE_EN | CTRL2_UV_AVG_EN | CTRL2_CMX_EN | CTRL2_UV_ADJ_EN},
- {0xff, 0xff},
-};
-
-static const uint8_t uxga_regs[][2] = {
- {BANK_SEL, BANK_SEL_SENSOR},
- {COM7, COM7_RES_UXGA},
- {COM1, 0x0F | 0x80},
- {HSTART, 0x11},
- {HSTOP, 0x75},
- {VSTART, 0x01},
- {VSTOP, 0x97},
- {REG32, 0x36},
- {BANK_SEL, BANK_SEL_DSP},
- {RESET, RESET_DVP},
- {SIZEL, SIZEL_HSIZE8_11_SET(UXGA_WIDTH) | SIZEL_HSIZE8_SET(UXGA_WIDTH) | SIZEL_VSIZE8_SET(UXGA_HEIGHT)},
- {HSIZE8, HSIZE8_SET(UXGA_WIDTH)},
- {VSIZE8, VSIZE8_SET(UXGA_HEIGHT)},
- {CTRL2, CTRL2_DCW_EN | CTRL2_SDE_EN | CTRL2_UV_AVG_EN | CTRL2_CMX_EN | CTRL2_UV_ADJ_EN},
- {0xff, 0xff},
-};
-
-static const uint8_t yuv422_regs[][2] = {
- {BANK_SEL, BANK_SEL_DSP},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {IMAGE_MODE, IMAGE_MODE_YUV422},
- {0xd7, 0x03},
- {0x33, 0xa0},
- {0xe5, 0x1f},
- {0xe1, 0x67},
- {RESET, 0x00},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {0xff, 0xff},
-};
-
-static const uint8_t rgb565_regs[][2] = {
- {BANK_SEL, BANK_SEL_DSP},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {IMAGE_MODE, IMAGE_MODE_RGB565},
- {0xd7, 0x03},
- {RESET, 0x00},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {0xff, 0xff},
-};
-
-static const uint8_t bayer_regs[][2] = {
- {BANK_SEL, BANK_SEL_DSP},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {IMAGE_MODE, IMAGE_MODE_RAW10},
- {0xd7, 0x03},
- {RESET, 0x00},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {0xff, 0xff},
-};
-
-static const uint8_t jpeg_regs[][2] = {
- {BANK_SEL, BANK_SEL_DSP},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {IMAGE_MODE, IMAGE_MODE_JPEG_EN},
- {0xd7, 0x03},
- {RESET, 0x00},
- {R_BYPASS, R_BYPASS_DSP_EN},
- {0xff, 0xff},
-};
-
-#define NUM_BRIGHTNESS_LEVELS (5)
-static const uint8_t brightness_regs[NUM_BRIGHTNESS_LEVELS + 1][5] = {
- {BPADDR, BPDATA, BPADDR, BPDATA, BPDATA},
- {0x00, 0x04, 0x09, 0x00, 0x00}, /* -2 */
- {0x00, 0x04, 0x09, 0x10, 0x00}, /* -1 */
- {0x00, 0x04, 0x09, 0x20, 0x00}, /* 0 */
- {0x00, 0x04, 0x09, 0x30, 0x00}, /* +1 */
- {0x00, 0x04, 0x09, 0x40, 0x00}, /* +2 */
-};
-
-#define NUM_CONTRAST_LEVELS (5)
-static const uint8_t contrast_regs[NUM_CONTRAST_LEVELS + 1][7] = {
- {BPADDR, BPDATA, BPADDR, BPDATA, BPDATA, BPDATA, BPDATA},
- {0x00, 0x04, 0x07, 0x20, 0x18, 0x34, 0x06}, /* -2 */
- {0x00, 0x04, 0x07, 0x20, 0x1c, 0x2a, 0x06}, /* -1 */
- {0x00, 0x04, 0x07, 0x20, 0x20, 0x20, 0x06}, /* 0 */
- {0x00, 0x04, 0x07, 0x20, 0x24, 0x16, 0x06}, /* +1 */
- {0x00, 0x04, 0x07, 0x20, 0x28, 0x0c, 0x06}, /* +2 */
-};
-
-#define NUM_SATURATION_LEVELS (5)
-static const uint8_t saturation_regs[NUM_SATURATION_LEVELS + 1][5] = {
- {BPADDR, BPDATA, BPADDR, BPDATA, BPDATA},
- {0x00, 0x02, 0x03, 0x28, 0x28}, /* -2 */
- {0x00, 0x02, 0x03, 0x38, 0x38}, /* -1 */
- {0x00, 0x02, 0x03, 0x48, 0x48}, /* 0 */
- {0x00, 0x02, 0x03, 0x58, 0x58}, /* +1 */
- {0x00, 0x02, 0x03, 0x68, 0x68}, /* +2 */
-};
-
-static int reg_read(int8_t reg, uint8_t *data) {
- return eos_i2c_read8(OV2640_ADDR, reg, data, 1);
-}
-
-static int reg_write(uint8_t reg, uint8_t data) {
- return eos_i2c_write8(OV2640_ADDR, reg, &data, 1);
-}
-
-static int regarr_write(const uint8_t (*regs)[2]) {
- int i, rv;
-
- i = 0;
- rv = EOS_OK;
-
- while ((regs[i][0] != 0xff) || (regs[i][1] != 0xff)) {
- if (!rv) rv = reg_write(regs[i][0], regs[i][1]);
- i++;
- }
-
- return rv;
-}
-
-int eos_ov2640_init(void) {
- int rv;
-
- // Reset all registers
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_write(COM7, COM7_SRST);
- if (rv) return rv;
-
- // Delay 5 ms
- eos_time_sleep(5);
-
- // Write default regsiters
- rv = regarr_write(default_regs);
- if (rv) return rv;
-
- // Delay 300 ms
- eos_time_sleep(300);
-
- return EOS_OK;
-}
-
-int eos_ov2640_sleep(int enable) {
- uint8_t reg;
- int rv;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(COM2, &reg);
- if (rv) return rv;
-
- if (enable) {
- reg |= COM2_STDBY;
- } else {
- reg &= ~COM2_STDBY;
- }
-
- // Write back register
- return reg_write(COM2, reg);
-}
-
-int eos_ov2640_set_pixfmt(pixformat_t fmt) {
- const uint8_t (*regs)[2];
-
- switch (fmt) {
- case PIXFORMAT_RGB565:
- regs = rgb565_regs;
- break;
- case PIXFORMAT_YUV422:
- case PIXFORMAT_GRAYSCALE:
- regs = yuv422_regs;
- break;
- case PIXFORMAT_BAYER:
- regs = bayer_regs;
- break;
- case PIXFORMAT_JPEG:
- regs = jpeg_regs;
- break;
- default:
- return EOS_ERR;
- }
-
- return regarr_write(regs);
-}
-
-int eos_ov2640_set_framesize(framesize_t framesize) {
- const uint8_t (*regs)[2];
- uint16_t sensor_w = 0;
- uint16_t sensor_h = 0;
- uint16_t w = _eos_cam_resolution[framesize][0];
- uint16_t h = _eos_cam_resolution[framesize][1];
- int rv;
-
- if ((w % 4) || (h % 4) || (w > UXGA_WIDTH) || (h > UXGA_HEIGHT)) { // w/h must be divisble by 4
- return EOS_ERR;
- }
-
- // Looks really bad.
- /* if ((w <= CIF_WIDTH) && (h <= CIF_HEIGHT)) {
- regs = cif_regs;
- sensor_w = CIF_WIDTH;
- sensor_h = CIF_HEIGHT;
- } else */ if ((w <= SVGA_WIDTH) && (h <= SVGA_HEIGHT)) {
- regs = svga_regs;
- sensor_w = SVGA_WIDTH;
- sensor_h = SVGA_HEIGHT;
- } else {
- regs = uxga_regs;
- sensor_w = UXGA_WIDTH;
- sensor_h = UXGA_HEIGHT;
- }
-
- // Write setup regsiters
- rv = regarr_write(regs);
- if (rv) return rv;
-
- uint64_t tmp_div = IM_MIN(sensor_w / w, sensor_h / h);
- uint16_t log_div = IM_MIN(IM_LOG2(tmp_div) - 1, 3);
- uint16_t div = 1 << log_div;
- uint16_t w_mul = w * div;
- uint16_t h_mul = h * div;
- uint16_t x_off = (sensor_w - w_mul) / 2;
- uint16_t y_off = (sensor_h - h_mul) / 2;
-
- rv = EOS_OK;
- if (!rv) rv = reg_write(CTRLI, CTRLI_LP_DP | CTRLI_V_DIV_SET(log_div) | CTRLI_H_DIV_SET(log_div));
- if (!rv) rv = reg_write(HSIZE, HSIZE_SET(w_mul));
- if (!rv) rv = reg_write(VSIZE, VSIZE_SET(h_mul));
- if (!rv) rv = reg_write(XOFFL, XOFFL_SET(x_off));
- if (!rv) rv = reg_write(YOFFL, YOFFL_SET(y_off));
- if (!rv) rv = reg_write(VHYX, VHYX_HSIZE_SET(w_mul) | VHYX_VSIZE_SET(h_mul) | VHYX_XOFF_SET(x_off) | VHYX_YOFF_SET(y_off));
- if (!rv) rv = reg_write(TEST, TEST_HSIZE_SET(w_mul));
- if (!rv) rv = reg_write(ZMOW, ZMOW_OUTW_SET(w));
- if (!rv) rv = reg_write(ZMOH, ZMOH_OUTH_SET(h));
- if (!rv) rv = reg_write(ZMHH, ZMHH_OUTW_SET(w) | ZMHH_OUTH_SET(h));
- if (!rv) rv = reg_write(R_DVP_SP, div);
- if (!rv) rv = reg_write(RESET, 0x00);
-
- return rv;
-}
-
-int eos_ov2640_set_contrast(int level) {
- int rv = EOS_OK;
-
- level += (NUM_CONTRAST_LEVELS / 2) + 1;
- if (level <= 0 || level > NUM_CONTRAST_LEVELS) {
- return EOS_ERR;
- }
-
- /* Switch to DSP register bank */
- rv = reg_write(BANK_SEL, BANK_SEL_DSP);
-
- /* Write contrast registers */
- for (int i=0; i<sizeof(contrast_regs[0])/sizeof(contrast_regs[0][0]); i++) {
- if (!rv) rv = reg_write(contrast_regs[0][i], contrast_regs[level][i]);
- }
-
- return rv;
-}
-
-int eos_ov2640_set_brightness(int level) {
- int rv = EOS_OK;
-
- level += (NUM_BRIGHTNESS_LEVELS / 2) + 1;
- if (level <= 0 || level > NUM_BRIGHTNESS_LEVELS) {
- return EOS_ERR;
- }
-
- /* Switch to DSP register bank */
- rv = reg_write(BANK_SEL, BANK_SEL_DSP);
-
- /* Write brightness registers */
- for (int i=0; i<sizeof(brightness_regs[0])/sizeof(brightness_regs[0][0]); i++) {
- if (!rv) rv = reg_write(brightness_regs[0][i], brightness_regs[level][i]);
- }
-
- return rv;
-}
-
-int eos_ov2640_set_saturation(int level) {
- int rv = EOS_OK;
-
- level += (NUM_SATURATION_LEVELS / 2) + 1;
- if (level <= 0 || level > NUM_SATURATION_LEVELS) {
- return EOS_ERR;
- }
-
- /* Switch to DSP register bank */
- rv = reg_write(BANK_SEL, BANK_SEL_DSP);
-
- /* Write saturation registers */
- for (int i=0; i<sizeof(saturation_regs[0])/sizeof(saturation_regs[0][0]); i++) {
- if (!rv) rv = reg_write(saturation_regs[0][i], saturation_regs[level][i]);
- }
-
- return rv;
-}
-
-int eos_ov2640_set_gainceiling(gainceiling_t gainceiling) {
- int rv = EOS_OK;
-
- /* Switch to SENSOR register bank */
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
-
- /* Write gain ceiling register */
- if (!rv) rv = reg_write(COM9, COM9_AGC_SET(gainceiling));
-
- return rv;
-}
-
-int eos_ov2640_set_quality(int qs) {
- int rv = EOS_OK;
-
- /* Switch to DSP register bank */
- rv = reg_write(BANK_SEL, BANK_SEL_DSP);
-
- /* Write QS register */
- if (!rv) rv = reg_write(QS, qs);
-
- return rv;
-}
-
-int eos_ov2640_set_colorbar(int enable) {
- int rv = EOS_OK;
- uint8_t reg;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(COM7, &reg);
- if (rv) return rv;
-
- if (enable) {
- reg |= COM7_COLOR_BAR;
- } else {
- reg &= ~COM7_COLOR_BAR;
- }
-
- return reg_write(COM7, reg);
-}
-
-int eos_ov2640_set_auto_gain(int enable, float gain_db, float gain_db_ceiling) {
- int rv = EOS_OK;
- uint8_t reg;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(COM8, &reg);
- if (rv) return rv;
-
- rv = reg_write(COM8, (reg & (~COM8_AGC_EN)) | (enable ? COM8_AGC_EN : 0));
- if (rv) return rv;
-
- rv = EOS_OK;
- if (enable && (!isnanf(gain_db_ceiling)) && (!isinff(gain_db_ceiling))) {
- float gain_ceiling = IM_MAX(IM_MIN(expf((gain_db_ceiling / 20.0) * logf(10.0)), 128.0), 2.0);
-
- if (!rv) rv = reg_read(COM9, &reg);
- if (!rv) rv = reg_write(COM9, (reg & 0x1F) | (((int)ceilf(log2f(gain_ceiling)) - 1) << 5));
- }
-
- if (!enable && (!isnanf(gain_db)) && (!isinff(gain_db))) {
- float gain = IM_MAX(IM_MIN(expf((gain_db / 20.0) * logf(10.0)), 32.0), 1.0);
-
- int gain_temp = roundf(log2f(IM_MAX(gain / 2.0, 1.0)));
- int gain_hi = 0xF >> (4 - gain_temp);
- int gain_lo = IM_MIN(roundf(((gain / (1 << gain_temp)) - 1.0) * 16.0), 15);
-
- if (!rv) rv = reg_write(GAIN, (gain_hi << 4) | (gain_lo << 0));
- }
-
- return rv;
-}
-
-int eos_ov2640_get_gain_db(float *gain_db) {
- int rv = EOS_OK;
- uint8_t reg, gain;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(COM8, &reg);
- if (rv) return rv;
-
- // DISABLED
- // if (reg & COM8_AGC_EN) {
- // rv = reg_write(COM8, reg & (~COM8_AGC_EN));
- // if (rv) return rv;
- // }
- // DISABLED
-
- rv = reg_read(GAIN, &gain);
- if (rv) return rv;
-
- // DISABLED
- // if (reg & COM8_AGC_EN) {
- // rv = reg_write(COM8, reg | COM8_AGC_EN);
- // if (rv) return rv;
- // }
- // DISABLED
-
- int hi_gain = 1 << (((gain >> 7) & 1) + ((gain >> 6) & 1) + ((gain >> 5) & 1) + ((gain >> 4) & 1));
- float lo_gain = 1.0 + (((gain >> 0) & 0xF) / 16.0);
- *gain_db = 20.0 * (logf(hi_gain * lo_gain) / logf(10.0));
-
- return EOS_OK;
-}
-
-int eos_ov2640_set_auto_exposure(int enable, int exposure_us) {
- int rv = EOS_OK;
- uint8_t reg;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(COM8, &reg);
- if (rv) return rv;
-
- rv = reg_write(COM8, COM8_SET_AEC(reg, (enable != 0)));
- if (rv) return rv;
-
- if (!enable && (exposure_us >= 0)) {
- rv = reg_read(COM7, &reg);
- if (rv) return rv;
-
- int t_line = 0;
-
- if (COM7_GET_RES(reg) == COM7_RES_UXGA) t_line = 1600 + 322;
- if (COM7_GET_RES(reg) == COM7_RES_SVGA) t_line = 800 + 390;
- if (COM7_GET_RES(reg) == COM7_RES_CIF) t_line = 400 + 195;
-
- rv = reg_read(CLKRC, &reg);
- if (rv) return rv;
-
- int pll_mult = ((reg & CLKRC_DOUBLE) ? 2 : 1) * 3;
- int clk_rc = (reg & CLKRC_DIVIDER_MASK) + 2;
-
- rv = reg_write(BANK_SEL, BANK_SEL_DSP);
- if (rv) return rv;
-
- rv = reg_read(IMAGE_MODE, &reg);
- if (rv) return rv;
-
- int t_pclk = 0;
-
- if (IMAGE_MODE_GET_FMT(reg) == IMAGE_MODE_YUV422) t_pclk = 2;
- if (IMAGE_MODE_GET_FMT(reg) == IMAGE_MODE_RAW10) t_pclk = 1;
- if (IMAGE_MODE_GET_FMT(reg) == IMAGE_MODE_RGB565) t_pclk = 2;
-
- int exposure = IM_MAX(IM_MIN(((exposure_us*(((XCLK_FREQ/clk_rc)*pll_mult)/1000000))/t_pclk)/t_line,0xFFFF),0x0000);
-
- if (!rv) rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
-
- if (!rv) rv = reg_read(REG04, &reg);
- if (!rv) rv = reg_write(REG04, (reg & 0xFC) | ((exposure >> 0) & 0x3));
-
- if (!rv) rv = reg_read(AEC, &reg);
- if (!rv) rv = reg_write(AEC, (reg & 0x00) | ((exposure >> 2) & 0xFF));
-
- if (!rv) rv = reg_read(REG45, &reg);
- if (!rv) rv = reg_write(REG45, (reg & 0xC0) | ((exposure >> 10) & 0x3F));
- }
-
- return rv;
-}
-
-int eos_ov2640_get_exposure_us(int *exposure_us) {
- int rv = EOS_OK;
- uint8_t reg, aec_10, aec_92, aec_1510;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(COM8, &reg);
- if (rv) return rv;
-
- // DISABLED
- // if (reg & COM8_AEC_EN) {
- // rv = reg_write(COM8, reg & (~COM8_AEC_EN));
- // if (rv) return rv;
- // }
- // DISABLED
-
- rv = reg_read(REG04, &aec_10);
- if (rv) return rv;
-
- rv = reg_read(AEC, &aec_92);
- if (rv) return rv;
-
- rv = reg_read(REG45, &aec_1510);
- if (rv) return rv;
-
- // DISABLED
- // if (reg & COM8_AEC_EN) {
- // rv = reg_write(COM8, reg | COM8_AEC_EN);
- // if (rv) return rv;
- // }
- // DISABLED
-
- rv = reg_read(COM7, &reg);
- if (rv) return rv;
-
- int t_line = 0;
-
- if (COM7_GET_RES(reg) == COM7_RES_UXGA) t_line = 1600 + 322;
- if (COM7_GET_RES(reg) == COM7_RES_SVGA) t_line = 800 + 390;
- if (COM7_GET_RES(reg) == COM7_RES_CIF) t_line = 400 + 195;
-
- rv = reg_read(CLKRC, &reg);
- if (rv) return rv;
-
- int pll_mult = ((reg & CLKRC_DOUBLE) ? 2 : 1) * 3;
- int clk_rc = (reg & CLKRC_DIVIDER_MASK) + 2;
-
- rv = reg_write(BANK_SEL, BANK_SEL_DSP);
- if (rv) return rv;
-
- rv = reg_read(IMAGE_MODE, &reg);
- if (rv) return rv;
-
- int t_pclk = 0;
-
- if (IMAGE_MODE_GET_FMT(reg) == IMAGE_MODE_YUV422) t_pclk = 2;
- if (IMAGE_MODE_GET_FMT(reg) == IMAGE_MODE_RAW10) t_pclk = 1;
- if (IMAGE_MODE_GET_FMT(reg) == IMAGE_MODE_RGB565) t_pclk = 2;
-
- uint16_t exposure = ((aec_1510 & 0x3F) << 10) + ((aec_92 & 0xFF) << 2) + ((aec_10 & 0x3) << 0);
- *exposure_us = (exposure*t_line*t_pclk)/(((XCLK_FREQ/clk_rc)*pll_mult)/1000000);
-
- return EOS_OK;
-}
-
-int eos_ov2640_set_auto_whitebal(int enable, float r_gain_db, float g_gain_db, float b_gain_db) {
- int rv = EOS_OK;
- uint8_t reg;
-
- rv = reg_write(BANK_SEL, BANK_SEL_DSP);
- if (rv) return rv;
-
- rv = reg_read(CTRL1, &reg);
- if (rv) return rv;
-
- rv = reg_write(CTRL1, (reg & (~CTRL1_AWB)) | (enable ? CTRL1_AWB : 0));
- if (rv) return rv;
-
- if (!enable && (!isnanf(r_gain_db)) && (!isnanf(g_gain_db)) && (!isnanf(b_gain_db))
- && (!isinff(r_gain_db)) && (!isinff(g_gain_db)) && (!isinff(b_gain_db))) {
- }
-
- return rv;
-}
-
-int eos_ov2640_set_hmirror(int enable) {
- int rv = EOS_OK;
- uint8_t reg;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(REG04, &reg);
- if (rv) return rv;
-
- if (!enable) { // Already mirrored.
- reg |= REG04_HFLIP_IMG;
- } else {
- reg &= ~REG04_HFLIP_IMG;
- }
-
- return reg_write(REG04, reg);
-}
-
-int eos_ov2640_set_vflip(int enable) {
- int rv = EOS_OK;
- uint8_t reg;
-
- rv = reg_write(BANK_SEL, BANK_SEL_SENSOR);
- if (rv) return rv;
-
- rv = reg_read(REG04, &reg);
- if (rv) return rv;
-
- if (!enable) { // Already flipped.
- reg |= REG04_VFLIP_IMG | REG04_VREF_EN;
- } else {
- reg &= ~(REG04_VFLIP_IMG | REG04_VREF_EN);
- }
-
- return reg_write(REG04, reg);
-}
-
-int eos_ov2640_set_effect(sde_t sde) {
- int rv = EOS_OK;
-
- switch (sde) {
- case SDE_NEGATIVE:
- if (!rv) rv = reg_write(BANK_SEL, BANK_SEL_DSP);
- if (!rv) rv = reg_write(BPADDR, 0x00);
- if (!rv) rv = reg_write(BPDATA, 0x40);
- if (!rv) rv = reg_write(BPADDR, 0x05);
- if (!rv) rv = reg_write(BPDATA, 0x80);
- if (!rv) rv = reg_write(BPDATA, 0x80);
- break;
- case SDE_NORMAL:
- if (!rv) rv = reg_write(BANK_SEL, BANK_SEL_DSP);
- if (!rv) rv = reg_write(BPADDR, 0x00);
- if (!rv) rv = reg_write(BPDATA, 0x00);
- if (!rv) rv = reg_write(BPADDR, 0x05);
- if (!rv) rv = reg_write(BPDATA, 0x80);
- if (!rv) rv = reg_write(BPDATA, 0x80);
- break;
- default:
- return EOS_ERR;
- }
-
- return rv;
-}
diff --git a/fw/fe310/eos/i2c/ov2640.h b/fw/fe310/eos/i2c/ov2640.h
deleted file mode 100644
index 3d08c2a..0000000
--- a/fw/fe310/eos/i2c/ov2640.h
+++ /dev/null
@@ -1,8 +0,0 @@
-#include <stdint.h>
-
-#define OV2640_ADDR 0x30
-
-int eos_ov2640_init(void);
-int eos_ov2640_sleep(int enable);
-int eos_ov2640_set_pixfmt(pixformat_t fmt);
-int eos_ov2640_set_framesize(framesize_t framesize);
diff --git a/fw/fe310/eos/i2c/ov2640_regs.h b/fw/fe310/eos/i2c/ov2640_regs.h
deleted file mode 100644
index deb7521..0000000
--- a/fw/fe310/eos/i2c/ov2640_regs.h
+++ /dev/null
@@ -1,245 +0,0 @@
-/*
- * This file is part of the OpenMV project.
- *
- * Copyright (c) 2013-2021 Ibrahim Abdelkader <iabdalkader@openmv.io>
- * Copyright (c) 2013-2021 Kwabena W. Agyeman <kwagyeman@openmv.io>
- *
- * This work is licensed under the MIT license, see the file LICENSE for details.
- *
- * OV2640 register definitions.
- */
-#ifndef __REG_REGS_H__
-#define __REG_REGS_H__
-
-/* DSP register bank FF=0x00*/
-
-#define QS 0x44
-#define HSIZE 0x51
-#define VSIZE 0x52
-#define XOFFL 0x53
-#define YOFFL 0x54
-#define VHYX 0x55
-#define DPRP 0x56
-#define TEST 0x57
-#define ZMOW 0x5A
-#define ZMOH 0x5B
-#define ZMHH 0x5C
-#define BPADDR 0x7C
-#define BPDATA 0x7D
-#define SIZEL 0x8C
-#define HSIZE8 0xC0
-#define VSIZE8 0xC1
-#define CTRL1 0xC3
-#define MS_SP 0xF0
-#define SS_ID 0xF7
-#define SS_CTRL 0xF7
-#define MC_AL 0xFA
-#define MC_AH 0xFB
-#define MC_D 0xFC
-#define P_CMD 0xFD
-#define P_STATUS 0xFE
-
-#define CTRLI 0x50
-#define CTRLI_LP_DP 0x80
-#define CTRLI_ROUND 0x40
-
-#define CTRL0 0xC2
-#define CTRL0_AEC_EN 0x80
-#define CTRL0_AEC_SEL 0x40
-#define CTRL0_STAT_SEL 0x20
-#define CTRL0_VFIRST 0x10
-#define CTRL0_YUV422 0x08
-#define CTRL0_YUV_EN 0x04
-#define CTRL0_RGB_EN 0x02
-#define CTRL0_RAW_EN 0x01
-
-#define CTRL2 0x86
-#define CTRL2_DCW_EN 0x20
-#define CTRL2_SDE_EN 0x10
-#define CTRL2_UV_ADJ_EN 0x08
-#define CTRL2_UV_AVG_EN 0x04
-#define CTRL2_CMX_EN 0x01
-
-#define CTRL3 0x87
-#define CTRL3_BPC_EN 0x80
-#define CTRL3_WPC_EN 0x40
-#define R_DVP_SP 0xD3
-#define R_DVP_SP_AUTO_MODE 0x80
-
-#define R_BYPASS 0x05
-#define R_BYPASS_DSP_EN 0x00
-#define R_BYPASS_DSP_BYPAS 0x01
-
-#define IMAGE_MODE 0xDA
-#define IMAGE_MODE_Y8_DVP_EN 0x40
-#define IMAGE_MODE_JPEG_EN 0x10
-#define IMAGE_MODE_YUV422 0x00
-#define IMAGE_MODE_RAW10 0x04
-#define IMAGE_MODE_RGB565 0x09
-#define IMAGE_MODE_HREF_VSYNC 0x02
-#define IMAGE_MODE_LBYTE_FIRST 0x01
-#define IMAGE_MODE_GET_FMT(x) ((x)&0xC)
-
-#define RESET 0xE0
-#define RESET_MICROC 0x40
-#define RESET_SCCB 0x20
-#define RESET_JPEG 0x10
-#define RESET_DVP 0x04
-#define RESET_IPU 0x02
-#define RESET_CIF 0x01
-
-#define MC_BIST 0xF9
-#define MC_BIST_RESET 0x80
-#define MC_BIST_BOOT_ROM_SEL 0x40
-#define MC_BIST_12KB_SEL 0x20
-#define MC_BIST_12KB_MASK 0x30
-#define MC_BIST_512KB_SEL 0x08
-#define MC_BIST_512KB_MASK 0x0C
-#define MC_BIST_BUSY_BIT_R 0x02
-#define MC_BIST_MC_RES_ONE_SH_W 0x02
-#define MC_BIST_LAUNCH 0x01
-
-#define BANK_SEL 0xFF
-#define BANK_SEL_DSP 0x00
-#define BANK_SEL_SENSOR 0x01
-
-/* Sensor register bank FF=0x01*/
-
-#define GAIN 0x00
-#define COM1 0x03
-#define REG_PID 0x0A
-#define REG_VER 0x0B
-#define COM4 0x0D
-#define AEC 0x10
-
-#define CLKRC 0x11
-#define CLKRC_DOUBLE 0x80
-#define CLKRC_DIVIDER_MASK 0x3F
-
-#define COM10 0x15
-#define HSTART 0x17
-#define HSTOP 0x18
-#define VSTART 0x19
-#define VSTOP 0x1A
-#define MIDH 0x1C
-#define MIDL 0x1D
-#define AEW 0x24
-#define AEB 0x25
-#define REG2A 0x2A
-#define FRARL 0x2B
-#define ADDVSL 0x2D
-#define ADDVSH 0x2E
-#define YAVG 0x2F
-#define HSDY 0x30
-#define HEDY 0x31
-#define ARCOM2 0x34
-#define REG45 0x45
-#define FLL 0x46
-#define FLH 0x47
-#define COM19 0x48
-#define ZOOMS 0x49
-#define COM22 0x4B
-#define COM25 0x4E
-#define BD50 0x4F
-#define BD60 0x50
-#define REG5D 0x5D
-#define REG5E 0x5E
-#define REG5F 0x5F
-#define REG60 0x60
-#define HISTO_LOW 0x61
-#define HISTO_HIGH 0x62
-
-#define REG04 0x04
-#define REG04_DEFAULT 0x28
-#define REG04_HFLIP_IMG 0x80
-#define REG04_VFLIP_IMG 0x40
-#define REG04_VREF_EN 0x10
-#define REG04_HREF_EN 0x08
-#define REG04_SET(x) (REG04_DEFAULT|x)
-
-#define REG08 0x08
-#define COM2 0x09
-#define COM2_STDBY 0x10
-#define COM2_OUT_DRIVE_1x 0x00
-#define COM2_OUT_DRIVE_2x 0x01
-#define COM2_OUT_DRIVE_3x 0x02
-#define COM2_OUT_DRIVE_4x 0x03
-
-#define COM3 0x0C
-#define COM3_DEFAULT 0x38
-#define COM3_BAND_50Hz 0x04
-#define COM3_BAND_60Hz 0x00
-#define COM3_BAND_AUTO 0x02
-#define COM3_BAND_SET(x) (COM3_DEFAULT|x)
-
-#define COM7 0x12
-#define COM7_SRST 0x80
-#define COM7_RES_UXGA 0x00 /* UXGA */
-#define COM7_RES_SVGA 0x40 /* SVGA */
-#define COM7_RES_CIF 0x20 /* CIF */
-#define COM7_ZOOM_EN 0x04 /* Enable Zoom */
-#define COM7_COLOR_BAR 0x02 /* Enable Color Bar Test */
-#define COM7_GET_RES(x) ((x)&0x70)
-
-#define COM8 0x13
-#define COM8_DEFAULT 0xC0
-#define COM8_BNDF_EN 0x20 /* Enable Banding filter */
-#define COM8_AGC_EN 0x04 /* AGC Auto/Manual control selection */
-#define COM8_AEC_EN 0x01 /* Auto/Manual Exposure control */
-#define COM8_SET(x) (COM8_DEFAULT|x)
-#define COM8_SET_AEC(r,x) (((r)&0xFE)|((x)&1))
-
-#define COM9 0x14 /* AGC gain ceiling */
-#define COM9_DEFAULT 0x08
-#define COM9_AGC_GAIN_2x 0x00 /* AGC: 2x */
-#define COM9_AGC_GAIN_4x 0x01 /* AGC: 4x */
-#define COM9_AGC_GAIN_8x 0x02 /* AGC: 8x */
-#define COM9_AGC_GAIN_16x 0x03 /* AGC: 16x */
-#define COM9_AGC_GAIN_32x 0x04 /* AGC: 32x */
-#define COM9_AGC_GAIN_64x 0x05 /* AGC: 64x */
-#define COM9_AGC_GAIN_128x 0x06 /* AGC: 128x */
-#define COM9_AGC_SET(x) (COM9_DEFAULT|(x<<5))
-
-#define CTRL1_AWB 0x08 /* Enable AWB */
-
-#define VV 0x26
-#define VV_AGC_TH_SET(h,l) ((h<<4)|(l&0x0F))
-
-#define REG32 0x32
-#define REG32_UXGA 0x36
-#define REG32_SVGA 0x09
-#define REG32_CIF 0x00
-
-#define VAL_SET(x, mask, rshift, lshift) ((((x) >> rshift) & mask) << lshift)
-
-#define CTRLI_V_DIV_SET(x) VAL_SET(x, 0x3, 0, 3)
-#define CTRLI_H_DIV_SET(x) VAL_SET(x, 0x3, 0, 0)
-
-#define SIZEL_HSIZE8_11_SET(x) VAL_SET(x, 0x1, 11, 6)
-#define SIZEL_HSIZE8_SET(x) VAL_SET(x, 0x7, 0, 3)
-#define SIZEL_VSIZE8_SET(x) VAL_SET(x, 0x7, 0, 0)
-
-#define HSIZE8_SET(x) VAL_SET(x, 0xFF, 3, 0)
-#define VSIZE8_SET(x) VAL_SET(x, 0xFF, 3, 0)
-
-#define HSIZE_SET(x) VAL_SET(x, 0xFF, 2, 0)
-#define VSIZE_SET(x) VAL_SET(x, 0xFF, 2, 0)
-
-#define XOFFL_SET(x) VAL_SET(x, 0xFF, 0, 0)
-#define YOFFL_SET(x) VAL_SET(x, 0xFF, 0, 0)
-
-#define VHYX_VSIZE_SET(x) VAL_SET(x, 0x1, (8+2), 7)
-#define VHYX_HSIZE_SET(x) VAL_SET(x, 0x1, (8+2), 3)
-#define VHYX_YOFF_SET(x) VAL_SET(x, 0x3, 8, 4)
-#define VHYX_XOFF_SET(x) VAL_SET(x, 0x3, 8, 0)
-
-#define TEST_HSIZE_SET(x) VAL_SET(x, 0x1, (9+2), 7)
-
-#define ZMOW_OUTW_SET(x) VAL_SET(x, 0xFF, 2, 0)
-#define ZMOH_OUTH_SET(x) VAL_SET(x, 0xFF, 2, 0)
-
-#define ZMHH_ZSPEED_SET(x) VAL_SET(x, 0x0F, 0, 4)
-#define ZMHH_OUTH_SET(x) VAL_SET(x, 0x1, (8+2), 2)
-#define ZMHH_OUTW_SET(x) VAL_SET(x, 0x3, (8+2), 0)
-
-#endif //__REG_REGS_H__