Skip to content

Commit

Permalink
Merge pull request #14 from IcingTomato/main
Browse files Browse the repository at this point in the history 
Add: Add Camera demo
  • Loading branch information
icing@tomato:~# authored May 22, 2023
2 parents 3c9d3b4 + 3515383 commit 7bc281f
Show file tree
Hide file tree
Showing 6 changed files with 2,431 additions and 0 deletions.
102 changes: 102 additions & 0 deletions examples/Basics/Camera/Camera.ino
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,102 @@
#include "esp_camera.h"
#include <WiFi.h>
#include <M5Unified.h>
#include <CoreS3_GC0308.hpp>

#define PWDN_GPIO_NUM -1
#define RESET_GPIO_NUM -1
#define XCLK_GPIO_NUM -1
#define SIOD_GPIO_NUM -1
#define SIOC_GPIO_NUM -1

#define Y2_GPIO_NUM 47
#define Y3_GPIO_NUM 48
#define Y4_GPIO_NUM 16
#define Y5_GPIO_NUM 15
#define Y6_GPIO_NUM 42
#define Y7_GPIO_NUM 41
#define Y8_GPIO_NUM 40
#define Y9_GPIO_NUM 39

#define VSYNC_GPIO_NUM 46
#define HREF_GPIO_NUM 38
#define PCLK_GPIO_NUM 45

// ===========================
// Enter your WiFi credentials
// ===========================
// const char* ssid = "**********";
// const char* password = "**********";

const char* ssid = "walawala";
const char* password = "walawala";

void startCameraServer();

void setup() {
M5.begin();
M5.Log.setEnableColor(m5::log_target_serial, false);
Serial.begin(115200);
Serial.println();

camera_config_t config;
config.ledc_channel = LEDC_CHANNEL_0;
config.ledc_timer = LEDC_TIMER_0;
config.pin_d0 = Y2_GPIO_NUM;
config.pin_d1 = Y3_GPIO_NUM;
config.pin_d2 = Y4_GPIO_NUM;
config.pin_d3 = Y5_GPIO_NUM;
config.pin_d4 = Y6_GPIO_NUM;
config.pin_d5 = Y7_GPIO_NUM;
config.pin_d6 = Y8_GPIO_NUM;
config.pin_d7 = Y9_GPIO_NUM;
config.pin_xclk = XCLK_GPIO_NUM;
config.pin_pclk = PCLK_GPIO_NUM;
config.pin_vsync = VSYNC_GPIO_NUM;
config.pin_href = HREF_GPIO_NUM;
config.pin_sccb_sda = SIOD_GPIO_NUM;
config.pin_sccb_scl = SIOC_GPIO_NUM;
config.pin_pwdn = PWDN_GPIO_NUM;
config.pin_reset = RESET_GPIO_NUM;
config.xclk_freq_hz = 20000000;
config.frame_size = FRAMESIZE_QVGA;
config.pixel_format = PIXFORMAT_RGB565;
config.grab_mode = CAMERA_GRAB_WHEN_EMPTY;
config.fb_location = CAMERA_FB_IN_PSRAM;
config.jpeg_quality = 0;
config.fb_count = 2;
config.sccb_i2c_port = M5.In_I2C.getPort();


// camera init
esp_err_t err = esp_camera_init(&config);
if (err != ESP_OK) {
Serial.printf("Camera init failed with error 0x%x", err);
return;
}
if(!cam::GC0308::complementDriver())
{
M5_LOGE("Failed to complement GC0308");
}

WiFi.begin(ssid, password);
WiFi.setSleep(false);

while (WiFi.status() != WL_CONNECTED) {
delay(500);
Serial.print(".");
}
Serial.println("");
Serial.println("WiFi connected");

startCameraServer();

Serial.print("Camera Ready! Use 'http://");
Serial.print(WiFi.localIP());
Serial.println("' to connect");
}

void loop() {
// Do nothing. Everything is done in another task by the web server
delay(1000);
}
269 changes: 269 additions & 0 deletions examples/Basics/Camera/CoreS3_GC0308.cpp
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,269 @@
#include <esp_camera.h>
#include "CoreS3_GC0308.hpp"
#include <esp32-hal-log.h>
#include <pgmspace.h>

// esp32-camera sccb.c
extern "C"
{
int SCCB_Write(uint8_t slv_addr, uint8_t reg, uint8_t data);
uint8_t SCCB_Read(uint8_t slv_addr, uint8_t reg);
}

template<typename T, size_t N> constexpr auto size(const T(&)[N]) noexcept -> size_t { return N; }

namespace
{
constexpr uint8_t REG_CONTRAST = 0xb3;
constexpr uint8_t REG_AGC_GAIN = 0x50;

struct RegVal { const uint8_t reg; const uint8_t val; };
struct Params { const size_t sz; const RegVal* params; };

// For special effect
PROGMEM const RegVal special_no_effect[] =
{
{ 0x23, 0x00 }, // special_effect [7:3] NA [2] edge_map [1] CbCr fixed enable [0] Inverse color
{ 0x20, 0x7f }, // Block_enable_1 [7] BKS_en [6] gamma enable [5] CC enable [4] Edge enhancement enable [3] Interpolation enable [2] Noise removal enable [1] Defect removal enable [0] Lens‐shading correction enabl
{ 0xd2, 0x90 }, // AEC_mode2 [7] AEC_en [6] map measure point [5] color Y mode [4] skin weight mode [3] NA [2] color select [1:0] NA
{ 0x73, 0x00 }, // EINTP mode 2 [7] edge_add_mode2 [6]NA [5] direction mode [4] fixed direction threshold [3:0] reserved
{ 0x77, 0x38 }, // Edge effect [7:4] edge effect1 [3:0] edge effect 2
{ 0xb3, 0x40 }, // Luma_contrast, can be adjusted viacontrast center 2.6bits, 0x40=1.0
{ 0xb4, 0x80 }, // Contrast center value
{ 0xba, 0x00 }, // S7, if fixed CbCr function is enabled, current image Cb value will be replace by this value to achieve special effect
{ 0xbb, 0x00 }, // S7, if fixed CbCr function is enabled, current image Cr value will be replace by this value to achieve special effect
};
PROGMEM const RegVal special_negative[] =
{
{ 0x23, 0x01 },
{ 0x20, 0x7f },
{ 0xd2, 0x90 },
{ 0x73, 0x00 },
{ 0xb3, 0x40 },
{ 0xb4, 0x80 },
{ 0xba, 0x00 },
{ 0xbb, 0x00 },
};

PROGMEM const RegVal special_grayscale[] =
{
{ 0x23, 0x02 },
{ 0x20, 0xff },
{ 0xd2, 0x90 },
{ 0x73, 0x00 },
{ 0x77, 0x54 },
{ 0xb3, 0x40 },
{ 0xb4, 0x80 },
{ 0xba, 0x00 },
{ 0xbb, 0x00 },
};

PROGMEM const RegVal special_red[] =
{
{ 0x23, 0x02 },
{ 0x20, 0x7f },
{ 0xd2, 0x90 },
{ 0x77, 0x00 },
{ 0xb3, 0x40 },
{ 0xb4, 0x80 },
{ 0xba, 0xe0 },
{ 0xbb, 0x50 },
};

PROGMEM const RegVal special_green[] =
{
{ 0x23, 0x02 },
{ 0x20, 0xff },
{ 0xd2, 0x90 },
{ 0x77, 0x88 },
{ 0xb3, 0x40 },
{ 0xb4, 0x80 },
{ 0xba, 0xc0 },
{ 0xbb, 0xc0 },
};

PROGMEM const RegVal special_blue[] =
{
{ 0x23, 0x02 },
{ 0x20, 0xff },
{ 0xd2, 0x90 },
{ 0x77, 0x00 },
{ 0xb3, 0x40 },
{ 0xb4, 0x80 },
{ 0xba, 0x50 },
{ 0xbb, 0xe0 },
};

PROGMEM const RegVal special_sepia[] =
{
{ 0x23, 0x02 },
{ 0x20, 0xff },
{ 0xd2, 0x90 },
{ 0x73, 0x00 },
{ 0xb3, 0x40 },
{ 0xb4, 0x80 },
{ 0xba, 0xd0 },
{ 0xbb, 0x20 },
};

PROGMEM const Params param_special_effect[] =
{
{ size(special_no_effect), special_no_effect },
{ size(special_negative), special_negative },
{ size(special_grayscale), special_grayscale },
{ size(special_red), special_red },
{ size(special_green), special_green },
{ size(special_blue), special_blue },
{ size(special_sepia), special_sepia },
};

// For White balance
PROGMEM const RegVal wb_auto[] =
{
{ 0x5a, 0x50 }, // AWB_R_gain 2.6 bits red channel gain from AWB
{ 0x5b, 0x40 }, // AWB_G_gain 2.6 bits green channel gain from AWB
{ 0x5c, 0x48 }, // AWB_B_gain 2.6 bits blue channel gain from AWB
};

PROGMEM const RegVal wb_sunny[] =
{
{ 0x5a, 0x5e },
{ 0x5b, 0x41 },
{ 0x5c, 0x54 },
};

PROGMEM const RegVal wb_cloudy[] =
{
{ 0x5a, 0x65 },
{ 0x5b, 0x41 },
{ 0x5c, 0x4f },
};

PROGMEM const RegVal wb_office[] =
{
{ 0x5a, 0x52 },
{ 0x5b, 0x41 },
{ 0x5c, 0x66 },
};

PROGMEM const RegVal wb_home[] =
{
{ 0x5a, 0x42 },
{ 0x5b, 0x3f },
{ 0x5c, 0x71 },
};


PROGMEM const Params param_wb[] =
{
{ size(wb_auto), wb_auto },
{ size(wb_sunny), wb_sunny },
{ size(wb_cloudy), wb_cloudy },
{ size(wb_office), wb_office },
{ size(wb_home), wb_home },
};

// --------------------------------
// Camera methods

using cam::GC0308::SpecialEffect::NoEffect;
using cam::GC0308::SpecialEffect::Sepia;
using cam::GC0308::WhiteBalance::Auto;
using cam::GC0308::WhiteBalance::Home;

int set_dummy(sensor_t*, int) { return -1; }

int set_contrast(sensor_t *s, int contrast)
{
s->status.contrast = contrast;;
int ret = SCCB_Write(s->slv_addr, 0xFE, 0); // page 0
ret |= SCCB_Write(s->slv_addr, REG_CONTRAST, contrast); //2.6bits, 0x40=1.x
return ret;
}

int set_agc_gain(sensor_t* s, int val)
{
if(val < 0 || val > 63) { return -1; }

s->status.agc_gain = val;
int ret = SCCB_Write(s->slv_addr, 0xFE, 0); // page 0
ret |= SCCB_Write(s->slv_addr, REG_AGC_GAIN, val); // [5:0] global_gain, 2.4bits, 0x10 is 1.0x
return ret;
}

int set_special_effect(sensor_t *s, int effect)
{
if(effect < NoEffect || effect > Sepia) { return -1; }

s->status.special_effect = effect;

int ret = SCCB_Write(s->slv_addr, 0xFE, 0); // page 0
size_t sz = param_special_effect[effect].sz;
auto p = param_special_effect[effect].params;
while(!ret && sz--)
{
ret |= SCCB_Write(s->slv_addr, p->reg, p->val);
++p;
}
return ret;
}

int set_wb_mode(sensor_t *s, int mode)
{
if(mode < Auto || mode > Home) { return -1; }

s->status.wb_mode = mode;

int ret = SCCB_Write(s->slv_addr, 0xFE, 0); // page 0

uint8_t rval = SCCB_Read(s->slv_addr, 0x22); // AAAA_enable [1] AWB enable
rval = (rval & ~0x02U) | ((mode == Auto) ? 0x02 : 0x00);
ret |= SCCB_Write(s->slv_addr, 0x22, rval);

size_t sz = param_wb[mode].sz;
auto p = param_wb[mode].params;
while(!ret && sz--)
{
ret |= SCCB_Write(s->slv_addr, p->reg, p->val);
++p;
}
return ret;
}
//
}

//
namespace cam { namespace GC0308 {

bool complementDriver()
{
auto s = esp_camera_sensor_get();
if(!s || s->id.PID != GC0308_PID) { log_e("GC0308 not detected"); return false; }

/*
Delete set_gain_ctrl
esp32-camera registers a function equivalent to set_agc_gain.
Is this a mistake since this method is supposed to turn on/off gain_ctrl?
*/
s->set_gain_ctrl = set_dummy;
s->status.agc = 0;

// Add agc gain
s->set_agc_gain = set_agc_gain;
s->status.agc_gain = SCCB_Read(s->slv_addr, REG_AGC_GAIN);
// Add special effect
s->set_special_effect = set_special_effect;
s->status.special_effect = cam::GC0308::SpecialEffect::NoEffect;
// Add wb_mode
s->set_wb_mode = set_wb_mode;
s->status.wb_mode = cam::GC0308::WhiteBalance::Auto;

// Replace set_contrast (Because the esp32-camera does not set a value to the status)
s->set_contrast = set_contrast;
s->status.contrast = SCCB_Read(s->slv_addr, REG_CONTRAST);

return true;
}

//
}}
Loading

0 comments on commit 7bc281f

Please sign in to comment.