9 changed files with 876 additions and 0 deletions
@ -0,0 +1,31 @@
@@ -0,0 +1,31 @@
|
||||
/*
|
||||
* |
||||
* SC030IOT DVP driver. |
||||
* |
||||
*/ |
||||
#ifndef __SC030IOT_H__ |
||||
#define __SC030IOT_H__ |
||||
|
||||
#include "sensor.h" |
||||
|
||||
/**
|
||||
* @brief Detect sensor pid |
||||
* |
||||
* @param slv_addr SCCB address |
||||
* @param id Detection result |
||||
* @return |
||||
* 0: Can't detect this sensor |
||||
* Nonzero: This sensor has been detected |
||||
*/ |
||||
int sc030iot_detect(int slv_addr, sensor_id_t *id); |
||||
|
||||
/**
|
||||
* @brief initialize sensor function pointers |
||||
* |
||||
* @param sensor pointer of sensor |
||||
* @return |
||||
* Always 0 |
||||
*/ |
||||
int sc030iot_init(sensor_t *sensor); |
||||
|
||||
#endif // __SC030IOT_H__
|
@ -0,0 +1,491 @@
@@ -0,0 +1,491 @@
|
||||
//version: V01P00_20220303
|
||||
//Preview Type:0:DVP Raw 10 bit// 1:Raw 8 bit// 2:YUV422// 3:RAW16
|
||||
//Preview Type:4:RGB565// 5:Pixart SPI// 6:MIPI 10bit// 7:MIPI 12bit// 8: MTK SPI
|
||||
//port 0:MIPI// 1:Parallel// 2:MTK// 3:SPI// 4:TEST// 5: HISPI// 6 : Z2P/Z4P
|
||||
//I2C Mode :0:Normal 8Addr,8Data// 1:Samsung 8 Addr,8Data// 2:Micron 8 Addr,16Data
|
||||
//I2C Mode :3:Stmicro 16Addr,8Data//4:Micron2 16 Addr,16Data
|
||||
//Out Format :0:YCbYCr/RG_GB// 1:YCrYCb/GR_BG// 2:CbYCrY/GB_RG// 3:CrYCbY/BG_GR
|
||||
//MCLK Speed :0:6M//1:8M//2:10M//3:11.4M//4:12M//5:12.5M//6:13.5M//7:15M//8:18M//9:24M
|
||||
//pin :BIT0 pwdn// BIT1:reset
|
||||
//avdd 0:3.3V// 1:2.5V// 2:1.8V
|
||||
//dovdd 0:2.8V// 1:2.5V// 2:1.8V
|
||||
//dvdd 0:1.8V// 1:1.5V// 2:1.2V
|
||||
|
||||
/*
|
||||
[DataBase] |
||||
DBName=Dothinkey |
||||
|
||||
[Vendor] |
||||
VendorName=SmartSens |
||||
|
||||
[Sensor] |
||||
SensorName=SC031IOT |
||||
width=640 |
||||
height=480 |
||||
port=1 |
||||
type=2 |
||||
pin=3 |
||||
SlaveID=0xd0 |
||||
mode=0 |
||||
FlagReg=0xf7 |
||||
FlagMask=0xff |
||||
FlagData=0xfa |
||||
FlagReg1=0xf8 |
||||
FlagMask1=0xff |
||||
FlagData1=0x46 |
||||
outformat=0 |
||||
mclk=20 |
||||
avdd=2.80000 |
||||
dovdd=2.800000 |
||||
dvdd=1.5 |
||||
|
||||
Ext0=0 |
||||
Ext1=0 |
||||
Ext2=0 |
||||
AFVCC=0.0000 |
||||
VPP=0.000000 |
||||
*/ |
||||
#include <stdint.h> |
||||
|
||||
static const uint8_t sc030iot_default_init_regs[][2] = { |
||||
{0xf0, 0x30}, |
||||
{0x01, 0xff}, |
||||
{0x02, 0xff}, |
||||
{0x22, 0x07}, |
||||
{0x19, 0xff}, |
||||
{0x3f, 0x82}, |
||||
{0x30, 0x02}, |
||||
{0xf0, 0x01}, |
||||
{0x70, 0x00}, |
||||
{0x71, 0x80}, |
||||
{0x72, 0x20}, |
||||
{0x73, 0x00}, |
||||
{0x74, 0xe0}, |
||||
{0x75, 0x10}, |
||||
{0x76, 0x81}, |
||||
{0x77, 0x88}, |
||||
{0x78, 0xe1}, |
||||
{0x79, 0x01}, |
||||
{0xf5, 0x01}, |
||||
{0xf4, 0x0a}, |
||||
{0xf0, 0x36}, |
||||
{0x37, 0x79}, |
||||
{0x31, 0x82}, |
||||
{0x3e, 0x60}, |
||||
{0x30, 0xf0}, |
||||
{0x33, 0x33}, |
||||
{0xf0, 0x32}, |
||||
{0x48, 0x02}, |
||||
{0xf0, 0x33}, |
||||
{0x02, 0x12}, |
||||
{0x7c, 0x02}, |
||||
{0x7d, 0x0e}, |
||||
{0xa2, 0x04}, |
||||
{0x5e, 0x06}, |
||||
{0x5f, 0x0a}, |
||||
{0x0b, 0x58}, |
||||
{0x06, 0x38}, |
||||
{0xf0, 0x32}, |
||||
{0x48, 0x02}, |
||||
{0xf0, 0x39}, |
||||
{0x02, 0x70}, |
||||
{0xf0, 0x45}, |
||||
{0x09, 0x1c}, |
||||
{0xf0, 0x37}, |
||||
{0x22, 0x0d}, |
||||
{0xf0, 0x33}, |
||||
{0x33, 0x10}, |
||||
{0xb1, 0x80}, |
||||
{0x34, 0x40}, |
||||
{0x0b, 0x54}, |
||||
{0xb2, 0x78}, |
||||
{0xf0, 0x36}, |
||||
{0x11, 0x80}, |
||||
{0xf0, 0x30}, |
||||
{0x38, 0x44}, |
||||
{0xf0, 0x33}, |
||||
{0xb3, 0x51}, |
||||
{0x01, 0x10}, |
||||
{0x0b, 0x6c}, |
||||
{0x06, 0x24}, |
||||
{0xf0, 0x36}, |
||||
{0x31, 0x82}, |
||||
{0x3e, 0x60}, |
||||
{0x30, 0xf0}, |
||||
{0x33, 0x33}, |
||||
{0xf0, 0x34}, |
||||
{0x9f, 0x02}, |
||||
{0xa6, 0x40}, |
||||
{0xa7, 0x47}, |
||||
{0xe8, 0x5f}, |
||||
{0xa8, 0x51}, |
||||
{0xa9, 0x44}, |
||||
{0xe9, 0x36}, |
||||
{0xf0, 0x33}, |
||||
{0xb3, 0x51}, |
||||
{0x64, 0x17}, |
||||
{0x90, 0x01}, |
||||
{0x91, 0x03}, |
||||
{0x92, 0x07}, |
||||
{0x01, 0x10}, |
||||
{0x93, 0x10}, |
||||
{0x94, 0x10}, |
||||
{0x95, 0x10}, |
||||
{0x96, 0x01}, |
||||
{0x97, 0x07}, |
||||
{0x98, 0x1f}, |
||||
{0x99, 0x10}, |
||||
{0x9a, 0x20}, |
||||
{0x9b, 0x28}, |
||||
{0x9c, 0x28}, |
||||
{0xf0, 0x36}, |
||||
{0x70, 0x54}, |
||||
{0xb6, 0x40}, |
||||
{0xb7, 0x41}, |
||||
{0xb8, 0x43}, |
||||
{0xb9, 0x47}, |
||||
{0xba, 0x4f}, |
||||
{0xb0, 0x8b}, |
||||
{0xb1, 0x8b}, |
||||
{0xb2, 0x8b}, |
||||
{0xb3, 0x9b}, |
||||
{0xb4, 0xb8}, |
||||
{0xb5, 0xf0}, |
||||
{0x7e, 0x41}, |
||||
{0x7f, 0x47}, |
||||
{0x77, 0x80}, |
||||
{0x78, 0x84}, |
||||
{0x79, 0x8a}, |
||||
{0xa0, 0x47}, |
||||
{0xa1, 0x5f}, |
||||
{0x96, 0x43}, |
||||
{0x97, 0x44}, |
||||
{0x98, 0x54}, |
||||
{0xf0, 0x00}, |
||||
{0xf0, 0x01}, |
||||
{0x73, 0x00}, |
||||
{0x74, 0xe0}, |
||||
{0x70, 0x00}, |
||||
{0x71, 0x80}, |
||||
{0xf0, 0x36}, |
||||
{0x37, 0x74}, |
||||
{0xf0, 0x3f}, |
||||
{0x03, 0xa1}, |
||||
{0xf0, 0x36},//cvbs_off
|
||||
{0x11, 0x80}, |
||||
{0xf0, 0x01}, |
||||
{0x79, 0xc1}, |
||||
{0xf0, 0x37}, |
||||
{0x24, 0x21}, |
||||
{0xf0, 0x36}, |
||||
{0x41, 0x00}, |
||||
{0xea, 0x09}, |
||||
{0xeb, 0x03}, |
||||
{0xec, 0x19}, |
||||
{0xed, 0x38}, |
||||
{0xe9, 0x30}, |
||||
{0xf0, 0x33}, |
||||
{0x33, 0x00}, |
||||
{0x34, 0x00}, |
||||
{0xb1, 0x00}, |
||||
{0xf0, 0x00}, |
||||
{0xe0, 0x04}, |
||||
{0xf0, 0x01}, |
||||
{0x73, 0x00}, |
||||
{0x74, 0xe0}, |
||||
{0x70, 0x00}, |
||||
{0x71, 0x80}, |
||||
{0xf0, 0x36}, |
||||
{0x32, 0x44}, |
||||
{0xf0, 0x36}, |
||||
{0x3e, 0xe0}, |
||||
{0x70, 0x56}, |
||||
{0x7c, 0x43}, |
||||
{0x7d, 0x47}, |
||||
{0x74, 0x00}, |
||||
{0x75, 0x00}, |
||||
{0x76, 0x00}, |
||||
{0xa0, 0x47}, |
||||
{0xa1, 0x5f}, |
||||
{0x96, 0x22}, |
||||
{0x97, 0x22}, |
||||
{0x98, 0x22}, |
||||
{0xf0, 0x00}, |
||||
{0x72, 0x38}, |
||||
{0x7a, 0x80}, |
||||
{0x85, 0x18}, |
||||
{0x9b, 0x35}, |
||||
{0x9e, 0x20}, |
||||
{0xd0, 0x66}, |
||||
{0xd1, 0x34}, |
||||
{0Xd3, 0x44}, |
||||
{0xd6, 0x44}, |
||||
{0xb0, 0x41}, |
||||
{0xb2, 0x48}, |
||||
{0xb3, 0xf4}, |
||||
{0xb4, 0x0b}, |
||||
{0xb5, 0x78}, |
||||
{0xba, 0xff}, |
||||
{0xbb, 0xc0}, |
||||
{0xbc, 0x90}, |
||||
{0xbd, 0x3a}, |
||||
{0xc1, 0x67}, |
||||
{0xf0, 0x01}, |
||||
{0x20, 0x11}, |
||||
{0x23, 0x90}, |
||||
{0x24, 0x15}, |
||||
{0x25, 0x87}, |
||||
{0xbc, 0x9f}, |
||||
{0xbd, 0x3a}, |
||||
{0x48, 0xe6}, |
||||
{0x49, 0xc0}, |
||||
{0x4a, 0xd0}, |
||||
{0x4b, 0x48}, |
||||
|
||||
// [cvbs_on]
|
||||
{0xf0, 0x36}, |
||||
{0x11, 0x00}, |
||||
{0xf0, 0x01}, |
||||
{0x79, 0xf1}, |
||||
|
||||
// [cvbs_off]
|
||||
{0xf0, 0x36}, |
||||
{0x11, 0x80}, |
||||
{0xf0, 0x01}, |
||||
{0x79, 0xc1}, |
||||
}; |
||||
|
||||
/*
|
||||
[Sensor] |
||||
SensorName=SC031IOT |
||||
width=640 |
||||
height=480 |
||||
port=1 |
||||
type=2 |
||||
pin=3 |
||||
SlaveID=0xd0 |
||||
mode=0 |
||||
FlagReg=0xf7 |
||||
FlagMask=0xff |
||||
FlagData=0xfa |
||||
FlagReg1=0xf8 |
||||
FlagMask1=0xff |
||||
FlagData1=0x46 |
||||
outformat=0 |
||||
mclk=27 |
||||
avdd=2.80000 |
||||
dovdd=2.800000 |
||||
dvdd=1.5 |
||||
|
||||
Ext0=0 |
||||
Ext1=0 |
||||
Ext2=0 |
||||
AFVCC=0.0000 |
||||
VPP=0.000000 |
||||
*/ |
||||
/* 27M MCLK, 30fps
|
||||
static const uint8_t sc030iot_default_init_regs[][2] = { |
||||
{0xf0, 0x30}, |
||||
{0x01, 0xff}, |
||||
{0x02, 0xff}, |
||||
{0x22, 0x07}, |
||||
{0x19, 0xff}, |
||||
{0x3f, 0x82}, |
||||
{0x30, 0x02}, |
||||
{0xf0, 0x01}, |
||||
{0x70, 0x00}, |
||||
{0x71, 0x80}, |
||||
{0x72, 0x20}, |
||||
{0x73, 0x00}, |
||||
{0x74, 0xe0}, |
||||
{0x75, 0x10}, |
||||
{0x76, 0x81}, |
||||
{0x77, 0x88}, |
||||
{0x78, 0xe1}, |
||||
{0x79, 0x01}, |
||||
{0xf5, 0x01}, |
||||
{0xf4, 0x0a}, |
||||
{0xf0, 0x36}, |
||||
{0x37, 0x79}, |
||||
{0x31, 0x82}, |
||||
{0x3e, 0x60}, |
||||
{0x30, 0xf0}, |
||||
{0x33, 0x33}, |
||||
{0xf0, 0x32}, |
||||
{0x48, 0x02}, |
||||
{0xf0, 0x33}, |
||||
{0x02, 0x12}, |
||||
{0x7c, 0x02}, |
||||
{0x7d, 0x0e}, |
||||
{0xa2, 0x04}, |
||||
{0x5e, 0x06}, |
||||
{0x5f, 0x0a}, |
||||
{0x0b, 0x58}, |
||||
{0x06, 0x38}, |
||||
{0xf0, 0x32}, |
||||
{0x48, 0x02}, |
||||
{0xf0, 0x39}, |
||||
{0x02, 0x70}, |
||||
{0xf0, 0x45}, |
||||
{0x09, 0x1c}, |
||||
{0xf0, 0x37}, |
||||
{0x22, 0x0d}, |
||||
{0xf0, 0x33}, |
||||
{0x33, 0x10}, |
||||
{0xb1, 0x80}, |
||||
{0x34, 0x40}, |
||||
{0x0b, 0x54}, |
||||
{0xb2, 0x78}, |
||||
{0xf0, 0x36}, |
||||
{0x11, 0x80}, |
||||
{0xf0, 0x30}, |
||||
{0x38, 0x44}, |
||||
{0xf0, 0x33}, |
||||
{0xb3, 0x51}, |
||||
{0x01, 0x10}, |
||||
{0x0b, 0x6c}, |
||||
{0x06, 0x24}, |
||||
{0xf0, 0x36}, |
||||
{0x31, 0x82}, |
||||
{0x3e, 0x60}, |
||||
{0x30, 0xf0}, |
||||
{0x33, 0x33}, |
||||
{0xf0, 0x34}, |
||||
{0x9f, 0x02}, |
||||
{0xa6, 0x40}, |
||||
{0xa7, 0x47}, |
||||
{0xe8, 0x5f}, |
||||
{0xa8, 0x51}, |
||||
{0xa9, 0x44}, |
||||
{0xe9, 0x36}, |
||||
{0xf0, 0x33}, |
||||
{0xb3, 0x51}, |
||||
{0x64, 0x17}, |
||||
{0x90, 0x01}, |
||||
{0x91, 0x03}, |
||||
{0x92, 0x07}, |
||||
{0x01, 0x10}, |
||||
{0x93, 0x10}, |
||||
{0x94, 0x10}, |
||||
{0x95, 0x10}, |
||||
{0x96, 0x01}, |
||||
{0x97, 0x07}, |
||||
{0x98, 0x1f}, |
||||
{0x99, 0x10}, |
||||
{0x9a, 0x20}, |
||||
{0x9b, 0x28}, |
||||
{0x9c, 0x28}, |
||||
{0xf0, 0x36}, |
||||
{0x70, 0x54}, |
||||
{0xb6, 0x40}, |
||||
{0xb7, 0x41}, |
||||
{0xb8, 0x43}, |
||||
{0xb9, 0x47}, |
||||
{0xba, 0x4f}, |
||||
{0xb0, 0x8b}, |
||||
{0xb1, 0x8b}, |
||||
{0xb2, 0x8b}, |
||||
{0xb3, 0x9b}, |
||||
{0xb4, 0xb8}, |
||||
{0xb5, 0xf0}, |
||||
{0x7e, 0x41}, |
||||
{0x7f, 0x47}, |
||||
{0x77, 0x80}, |
||||
{0x78, 0x84}, |
||||
{0x79, 0x8a}, |
||||
{0xa0, 0x47}, |
||||
{0xa1, 0x5f}, |
||||
{0x96, 0x43}, |
||||
{0x97, 0x44}, |
||||
{0x98, 0x54}, |
||||
{0xf0, 0x00}, |
||||
{0xf0, 0x01}, |
||||
{0x73, 0x00}, |
||||
{0x74, 0xe0}, |
||||
{0x70, 0x00}, |
||||
{0x71, 0x80}, |
||||
{0xf0, 0x36}, |
||||
{0x37, 0x74}, |
||||
{0xf0, 0x3f}, |
||||
{0x03, 0x93}, |
||||
{0xf0, 0x36},//cvbs_off
|
||||
{0x11, 0x80}, |
||||
{0xf0, 0x01}, |
||||
{0x79, 0xc1}, |
||||
{0xf0, 0x37}, |
||||
{0x24, 0x21}, |
||||
{0xf0, 0x36}, |
||||
{0x41, 0x00}, |
||||
{0xe9, 0x2c}, |
||||
{0xf0, 0x33}, |
||||
{0x33, 0x00}, |
||||
{0x34, 0x00}, |
||||
{0xb1, 0x00}, |
||||
{0xf0, 0x00}, |
||||
{0xe0, 0x04}, |
||||
{0xf0, 0x01}, |
||||
{0x73, 0x00}, |
||||
{0x74, 0xe0}, |
||||
{0x70, 0x00}, |
||||
{0x71, 0x80}, |
||||
{0xf0, 0x36}, |
||||
{0x32, 0x44}, |
||||
{0xf0, 0x36}, |
||||
{0x3e, 0xe0}, |
||||
{0x70, 0x56}, |
||||
{0x7c, 0x43}, |
||||
{0x7d, 0x47}, |
||||
{0x74, 0x00}, |
||||
{0x75, 0x00}, |
||||
{0x76, 0x00}, |
||||
{0xa0, 0x47}, |
||||
{0xa1, 0x5f}, |
||||
{0x96, 0x22}, |
||||
{0x97, 0x22}, |
||||
{0x98, 0x22}, |
||||
{0xf0, 0x00}, |
||||
{0x72, 0x38}, |
||||
{0x7a, 0x80}, |
||||
{0x85, 0x18}, |
||||
{0x9b, 0x35}, |
||||
{0x9e, 0x20}, |
||||
{0xd0, 0x66}, |
||||
{0xd1, 0x34}, |
||||
{0Xd3, 0x44}, |
||||
{0xd6, 0x44}, |
||||
{0xb0, 0x41}, |
||||
{0xb2, 0x48}, |
||||
{0xb3, 0xf4}, |
||||
{0xb4, 0x0b}, |
||||
{0xb5, 0x78}, |
||||
{0xba, 0xff}, |
||||
{0xbb, 0xc0}, |
||||
{0xbc, 0x90}, |
||||
{0xbd, 0x3a}, |
||||
{0xc1, 0x67}, |
||||
{0xf0, 0x01}, |
||||
{0x20, 0x11}, |
||||
{0x23, 0x90}, |
||||
{0x24, 0x15}, |
||||
{0x25, 0x87}, |
||||
{0xbc, 0x9f}, |
||||
{0xbd, 0x3a}, |
||||
{0x48, 0xe6}, |
||||
{0x49, 0xc0}, |
||||
{0x4a, 0xd0}, |
||||
{0x4b, 0x48}, |
||||
|
||||
// [cvbs_on]
|
||||
{0xf0, 0x36}, |
||||
{0x11, 0x00}, |
||||
{0xf0, 0x01}, |
||||
{0x79, 0xf1}, |
||||
|
||||
// [cvbs_off]
|
||||
{0xf0, 0x36}, |
||||
{0x11, 0x80}, |
||||
{0xf0, 0x01}, |
||||
{0x79, 0xc1}, |
||||
}; |
||||
|
||||
*/ |
@ -0,0 +1,335 @@
@@ -0,0 +1,335 @@
|
||||
/*
|
||||
* SC030IOT driver. |
||||
* |
||||
* Copyright 2020-2022 Espressif Systems (Shanghai) PTE LTD |
||||
* |
||||
* Licensed under the Apache License, Version 2.0 (the "License"); |
||||
* you may not use this file except in compliance with the License. |
||||
* You may obtain a copy of the License at |
||||
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
* |
||||
* Unless required by applicable law or agreed to in writing, software |
||||
* distributed under the License is distributed on an "AS IS" BASIS, |
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
||||
* See the License for the specific language governing permissions and |
||||
* limitations under the License. |
||||
* |
||||
*/ |
||||
#include <stdint.h> |
||||
#include <stdlib.h> |
||||
#include <string.h> |
||||
#include <stdio.h> |
||||
#include "sccb.h" |
||||
#include "xclk.h" |
||||
#include "freertos/FreeRTOS.h" |
||||
#include "freertos/task.h" |
||||
|
||||
#include "sc030iot.h" |
||||
#include "sc030iot_settings.h" |
||||
|
||||
#if defined(ARDUINO_ARCH_ESP32) && defined(CONFIG_ARDUHAL_ESP_LOG) |
||||
#include "esp32-hal-log.h" |
||||
#else |
||||
#include "esp_log.h" |
||||
static const char* TAG = "sc030"; |
||||
#endif |
||||
|
||||
#define SC030_SENSOR_ID_HIGH_REG 0XF7 |
||||
#define SC030_SENSOR_ID_LOW_REG 0XF8 |
||||
#define SC030_MAX_FRAME_WIDTH (640) |
||||
#define SC030_MAX_FRAME_HIGH (480) |
||||
|
||||
// sc030 use "i2c paging mode", so the high byte of the register needs to be written to the 0xf0 reg.
|
||||
// For more information please refer to the Technical Reference Manual.
|
||||
int get_reg(sensor_t *sensor, int reg, int reg_value_mask) |
||||
{ |
||||
int ret = 0; |
||||
uint8_t reg_high = (reg>>8) & 0xFF; |
||||
uint8_t reg_low = reg & 0xFF; |
||||
|
||||
if(SCCB_Write(sensor->slv_addr, 0xf0, reg_high)) { |
||||
return -1; |
||||
} |
||||
|
||||
ret = SCCB_Read(sensor->slv_addr, reg_low); |
||||
if(ret > 0){ |
||||
ret &= reg_value_mask; |
||||
} |
||||
return ret; |
||||
} |
||||
|
||||
// sc030 use "i2c paging mode", so the high byte of the register needs to be written to the 0xf0 reg.
|
||||
// For more information please refer to the Technical Reference Manual.
|
||||
int set_reg(sensor_t *sensor, int reg, int mask, int value) |
||||
{ |
||||
int ret = 0; |
||||
uint8_t reg_high = (reg>>8) & 0xFF; |
||||
uint8_t reg_low = reg & 0xFF; |
||||
|
||||
if(SCCB_Write(sensor->slv_addr, 0xf0, reg_high)) { |
||||
return -1; |
||||
} |
||||
|
||||
ret = SCCB_Write(sensor->slv_addr, reg_low, value & 0xFF); |
||||
return ret; |
||||
} |
||||
|
||||
static int set_regs(sensor_t *sensor, const uint8_t (*regs)[2], uint32_t regs_entry_len) |
||||
{ |
||||
int i=0, res = 0; |
||||
while (i<regs_entry_len) { |
||||
res = SCCB_Write(sensor->slv_addr, regs[i][0], regs[i][1]); |
||||
if (res) { |
||||
return res; |
||||
} |
||||
i++; |
||||
} |
||||
return res; |
||||
} |
||||
|
||||
static int set_reg_bits(sensor_t *sensor, int reg, uint8_t offset, uint8_t length, uint8_t value) |
||||
{ |
||||
int ret = 0; |
||||
ret = get_reg(sensor, reg, 0xff); |
||||
if(ret < 0){ |
||||
return ret; |
||||
} |
||||
uint8_t mask = ((1 << length) - 1) << offset; |
||||
value = (ret & ~mask) | ((value << offset) & mask); |
||||
ret = set_reg(sensor, reg & 0xFFFF, 0xFFFF, value); |
||||
return ret; |
||||
} |
||||
|
||||
#define WRITE_REGS_OR_RETURN(regs, regs_entry_len) ret = set_regs(sensor, regs, regs_entry_len); if(ret){return ret;} |
||||
#define WRITE_REG_OR_RETURN(reg, val) ret = set_reg(sensor, reg, 0xFF, val); if(ret){return ret;} |
||||
#define SET_REG_BITS_OR_RETURN(reg, offset, length, val) ret = set_reg_bits(sensor, reg, offset, length, val); if(ret){return ret;} |
||||
|
||||
static int set_hmirror(sensor_t *sensor, int enable) |
||||
{ |
||||
int ret = 0; |
||||
if(enable) { |
||||
SET_REG_BITS_OR_RETURN(0x3221, 1, 2, 0x3); // mirror on
|
||||
} else { |
||||
SET_REG_BITS_OR_RETURN(0x3221, 1, 2, 0x0); // mirror off
|
||||
} |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_vflip(sensor_t *sensor, int enable) |
||||
{ |
||||
int ret = 0; |
||||
if(enable) { |
||||
SET_REG_BITS_OR_RETURN(0x3221, 5, 2, 0x3); // flip on
|
||||
} else { |
||||
SET_REG_BITS_OR_RETURN(0x3221, 5, 2, 0x0); // flip off
|
||||
} |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_colorbar(sensor_t *sensor, int enable) |
||||
{ |
||||
int ret = 0; |
||||
SET_REG_BITS_OR_RETURN(0x0100, 7, 1, enable & 0xff); // enable test pattern mode
|
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_sharpness(sensor_t *sensor, int level) |
||||
{ |
||||
int ret = 0; |
||||
SET_REG_BITS_OR_RETURN(0x00e0, 1, 1, 1); // enable edge enhancement
|
||||
WRITE_REG_OR_RETURN(0x00d0, level & 0xFF); // base value
|
||||
WRITE_REG_OR_RETURN(0x00d2, (level >> 8) & 0xFF); // limit
|
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_agc_gain(sensor_t *sensor, int gain) |
||||
{ |
||||
int ret = 0; |
||||
SET_REG_BITS_OR_RETURN(0x0070, 1, 1, 1); // enable auto agc control
|
||||
WRITE_REG_OR_RETURN(0x0068, gain & 0xFF); // Window weight setting1
|
||||
WRITE_REG_OR_RETURN(0x0069, (gain >> 8) & 0xFF); // Window weight setting2
|
||||
WRITE_REG_OR_RETURN(0x006a, (gain >> 16) & 0xFF); // Window weight setting3
|
||||
WRITE_REG_OR_RETURN(0x006b, (gain >> 24) & 0xFF); // Window weight setting4
|
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_aec_value(sensor_t *sensor, int value) |
||||
{ |
||||
int ret = 0; |
||||
SET_REG_BITS_OR_RETURN(0x0070, 0, 1, 1); // enable auto aec control
|
||||
WRITE_REG_OR_RETURN(0x0072, value & 0xFF); // AE target
|
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_awb_gain(sensor_t *sensor, int value) |
||||
{ |
||||
int ret = 0; |
||||
SET_REG_BITS_OR_RETURN(0x00b0, 0, 1, 1); // enable awb control
|
||||
WRITE_REG_OR_RETURN(0x00c8, value & 0xFF); // blue gain
|
||||
WRITE_REG_OR_RETURN(0x00c9, (value>>8) & 0XFF); // red gain
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_saturation(sensor_t *sensor, int level) |
||||
{ |
||||
int ret = 0; |
||||
SET_REG_BITS_OR_RETURN(0x00f5, 5, 1, 0); // enable saturation control
|
||||
WRITE_REG_OR_RETURN(0x0149, level & 0xFF); // blue saturation gain (/128)
|
||||
WRITE_REG_OR_RETURN(0x014a, (level>>8) & 0XFF); // red saturation gain (/128)
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_contrast(sensor_t *sensor, int level) |
||||
{ |
||||
int ret = 0; |
||||
SET_REG_BITS_OR_RETURN(0x00f5, 6, 1, 0); // enable contrast control
|
||||
WRITE_REG_OR_RETURN(0x014b, level); // contrast coefficient(/64)
|
||||
return ret; |
||||
} |
||||
|
||||
static int reset(sensor_t *sensor) |
||||
{ |
||||
int ret = set_regs(sensor, sc030iot_default_init_regs, sizeof(sc030iot_default_init_regs)/(sizeof(uint8_t) * 2)); |
||||
|
||||
// Delay
|
||||
vTaskDelay(50 / portTICK_PERIOD_MS); |
||||
|
||||
// ESP_LOGI(TAG, "set_reg=%0x", set_reg(sensor, 0x0100, 0xffff, 0x00)); // write 0x80 to enter test mode if you want to test the sensor
|
||||
// ESP_LOGI(TAG, "0x0100=%0x", get_reg(sensor, 0x0100, 0xffff));
|
||||
if (ret) { |
||||
ESP_LOGE(TAG, "reset fail"); |
||||
} |
||||
return ret; |
||||
} |
||||
|
||||
static int set_window(sensor_t *sensor, int offset_x, int offset_y, int w, int h) |
||||
{ |
||||
int ret = 0; |
||||
//sc:H_start={0x0172[1:0],0x0170},H_end={0x0172[5:4],0x0171},
|
||||
WRITE_REG_OR_RETURN(0x0170, offset_x & 0xff); |
||||
WRITE_REG_OR_RETURN(0x0171, (offset_x+w) & 0xff); |
||||
WRITE_REG_OR_RETURN(0x0172, ((offset_x>>8) & 0x03) | (((offset_x+w)>>4)&0x30)); |
||||
|
||||
//sc:V_start={0x0175[1:0],0x0173},H_end={0x0175[5:4],0x0174},
|
||||
WRITE_REG_OR_RETURN(0x0173, offset_y & 0xff); |
||||
WRITE_REG_OR_RETURN(0x0174, (offset_y+h) & 0xff); |
||||
WRITE_REG_OR_RETURN(0x0175, ((offset_y>>8) & 0x03) | (((offset_y+h)>>4)&0x30)); |
||||
|
||||
vTaskDelay(10 / portTICK_PERIOD_MS); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int set_framesize(sensor_t *sensor, framesize_t framesize) |
||||
{ |
||||
uint16_t w = resolution[framesize].width; |
||||
uint16_t h = resolution[framesize].height; |
||||
if(w>SC030_MAX_FRAME_WIDTH || h > SC030_MAX_FRAME_HIGH) { |
||||
goto err; |
||||
} |
||||
|
||||
uint16_t offset_x = (640-w) /2; |
||||
uint16_t offset_y = (480-h) /2; |
||||
|
||||
if(set_window(sensor, offset_x, offset_y, w, h)) { |
||||
goto err; |
||||
} |
||||
|
||||
sensor->status.framesize = framesize; |
||||
return 0; |
||||
err: |
||||
ESP_LOGE(TAG, "frame size err"); |
||||
return -1; |
||||
} |
||||
|
||||
static int set_pixformat(sensor_t *sensor, pixformat_t pixformat) |
||||
{ |
||||
int ret=0; |
||||
sensor->pixformat = pixformat; |
||||
|
||||
switch (pixformat) { |
||||
case PIXFORMAT_RGB565: |
||||
case PIXFORMAT_RAW: |
||||
case PIXFORMAT_GRAYSCALE: |
||||
ESP_LOGE(TAG, "Not support"); |
||||
break; |
||||
case PIXFORMAT_YUV422: // For now, sc030/sc031 sensor only support YUV422.
|
||||
break; |
||||
default: |
||||
return -1; |
||||
} |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int init_status(sensor_t *sensor) |
||||
{ |
||||
return 0; |
||||
} |
||||
|
||||
static int set_dummy(sensor_t *sensor, int val){ return -1; } |
||||
|
||||
static int set_xclk(sensor_t *sensor, int timer, int xclk) |
||||
{ |
||||
int ret = 0; |
||||
sensor->xclk_freq_hz = xclk * 1000000U; |
||||
ret = xclk_timer_conf(timer, sensor->xclk_freq_hz); |
||||
return ret; |
||||
} |
||||
|
||||
int sc030iot_detect(int slv_addr, sensor_id_t *id) |
||||
{ |
||||
if (SC030IOT_SCCB_ADDR == slv_addr) { |
||||
uint8_t MIDL = SCCB_Read(slv_addr, SC030_SENSOR_ID_LOW_REG); |
||||
uint8_t MIDH = SCCB_Read(slv_addr, SC030_SENSOR_ID_HIGH_REG); |
||||
uint16_t PID = MIDH << 8 | MIDL; |
||||
if (SC030IOT_PID == PID) { |
||||
id->PID = PID; |
||||
return PID; |
||||
} else { |
||||
ESP_LOGI(TAG, "Mismatch PID=0x%x", PID); |
||||
} |
||||
} |
||||
return 0; |
||||
} |
||||
|
||||
int sc030iot_init(sensor_t *sensor) |
||||
{ |
||||
// Set function pointers
|
||||
sensor->reset = reset; |
||||
sensor->init_status = init_status; |
||||
sensor->set_pixformat = set_pixformat; |
||||
sensor->set_framesize = set_framesize; |
||||
|
||||
sensor->set_saturation= set_saturation; |
||||
sensor->set_colorbar = set_colorbar; |
||||
sensor->set_hmirror = set_hmirror; |
||||
sensor->set_vflip = set_vflip; |
||||
sensor->set_sharpness = set_sharpness; |
||||
sensor->set_agc_gain = set_agc_gain; |
||||
sensor->set_aec_value = set_aec_value; |
||||
sensor->set_awb_gain = set_awb_gain; |
||||
sensor->set_contrast = set_contrast; |
||||
//not supported
|
||||
sensor->set_denoise = set_dummy; |
||||
sensor->set_quality = set_dummy; |
||||
sensor->set_special_effect = set_dummy; |
||||
sensor->set_wb_mode = set_dummy; |
||||
sensor->set_ae_level = set_dummy; |
||||
|
||||
|
||||
sensor->get_reg = get_reg; |
||||
sensor->set_reg = set_reg; |
||||
sensor->set_xclk = set_xclk; |
||||
|
||||
ESP_LOGD(TAG, "sc030iot Attached"); |
||||
|
||||
return 0; |
||||
} |
Loading…
Reference in new issue