Codexzier_Versatron/SubCameraManager.cpp at main · Codexzier/Codexzier_Versatron · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
//
// Created by codexzier on 23.06.26.
//

#include "SubCameraManager.h"
#include "esp_camera.h"
#include "camera_pins.h"
#include <string>
#include <memory>

void SubCameraManager::init() {

    camera_config_t config;
    config.ledc_channel = LEDC_CHANNEL_0;
    config.ledc_timer = LEDC_TIMER_0;

    // data pins
    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;

    // control gpio
    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_sscb_sda = SIOD_GPIO_NUM;
    config.pin_sccb_sda = SIOD_GPIO_NUM;
    //config.pin_sscb_scl = SIOC_GPIO_NUM;
    config.pin_sccb_scl = SIOC_GPIO_NUM;

    // not connected
    config.pin_pwdn = PWDN_GPIO_NUM;
    config.pin_reset = RESET_GPIO_NUM;

    config.xclk_freq_hz = 20000000;

    // Bitmap Einstellung
    config.pixel_format = PIXFORMAT_RGB565;
    config.grab_mode = CAMERA_GRAB_WHEN_EMPTY;
    config.fb_location = CAMERA_FB_IN_PSRAM;
    config.jpeg_quality = 12;
    config.fb_count = 1;

    config.frame_size = FRAMESIZE_240X240;
    //#if CONFIG_IDF_TARGET_ESP32S3
    //  config.fb_count = 2;
    //#endif
    //}

    Serial.println("init camera");

    // camera init
    esp_err_t err = esp_camera_init(&config);
    if (err != ESP_OK) {
        Serial.printf("Camera init failed with error 0x%x", err);
        delay(1000);
        return;
    }

    // Camera initialization check passes
    _camera_sign = true;
}

CameraRecordResult SubCameraManager::getPicture() {
    // das erste bild aufrufen und verwerfen.
    camera_fb_t *fb_old = esp_camera_fb_get();
    esp_camera_fb_return(fb_old);

    // camera frame buffer
    camera_fb_t *fb = esp_camera_fb_get();

    CameraRecordResult result;

    if (!fb) {
        Serial.println("Failed to get camera frame buffer");
        result.Success = false;
        return result;
    }

    Serial.print("Length: "); Serial.println(fb->len, DEC);

    result.Buffer = fb->buf;
    result.Length = fb->len;
    result.Success = true;

    esp_camera_fb_return(fb);

    return result;
}

CameraRecordResult SubCameraManager::getPictureFast() {
    camera_fb_t *fb = esp_camera_fb_get();

    CameraRecordResult result;

    if (!fb) {
        Serial.println("Failed to get camera frame buffer");
        result.Success = false;
        return result;
    }

    result.Buffer = fb->buf;
    result.Length = fb->len;
    result.Success = true;

    esp_camera_fb_return(fb);

    return result;
}