Summary Files Commits Branches @commit @diff @stats
diff options
context:
space:
mode:
Commit58c66096783cb51ac8b7df846c383135f765f4f1 (patch)
Author
 Syndamia <kamen@syndamia.com>
2024-05-05 11:24:54 +0300
Committer
 Syndamia <kamen@syndamia.com>
2024-05-05 11:24:54 +0300
Filesf4c5f4883e02a58664db3e6436c295f64ef9af65
uni-projects-58c66096783cb51ac8b7df846c383135f765f4f1.tar
uni-projects-58c66096783cb51ac8b7df846c383135f765f4f1.tar.gz
uni-projects-58c66096783cb51ac8b7df846c383135f765f4f1.zip
Parentfb789d59604ae4141cf56981beec4293b235f55b (diff)
[iot/goam] Successful but ugly image reading
diff --git a/Year 3/Internet of things/goam/main/main.c b/Year 3/Internet of things/goam/main/main.c
index 9b08713..5e8e49f 100644
--- a/Year 3/Internet of things/goam/main/main.c
+++ b/Year 3/Internet of things/goam/main/main.c
@@ -75,8 +75,15 @@ void app_main(void)
ptc06_init();
- char* img = ptc06_shoot_photo();
- free(img);
+ char* image;
+ size_t length = ptc06_shoot_photo(&image);
+ for (int i = 0; i < length; i++) {
+ printf("%d ", image[i]);
+ if (i % 12 == 0)
+ printf("\n");
+ }
+ printf("\n");
+ free(image);
for (int i = 0; true; i++) {
ptc06_reset();
diff --git a/Year 3/Internet of things/goam/main/ptc06.c b/Year 3/Internet of things/goam/main/ptc06.c
index 652a065..c73227a 100644
--- a/Year 3/Internet of things/goam/main/ptc06.c
+++ b/Year 3/Internet of things/goam/main/ptc06.c
@@ -5,17 +5,19 @@
/* #include "esp_check.h" */
#include "ptc06.h"
+#include <string.h>
+
+#define wait(milliseconds) vTaskDelay(milliseconds / portTICK_PERIOD_MS);
#define UART_NUM UART_NUM_2
#define UART_TX 17
#define UART_RX 16
-#define UART_RTS 18
-#define UART_CTS 19
#define UART_BUFFER_SIZE 2048
// Setup UART buffered IO with event queue
static QueueHandle_t uart_queue;
#define QUEUE_SIZE 10
+static size_t serial_num = 0x00;
static const char* TAG = "ptc06";
@@ -26,7 +28,7 @@ static const char comm_capture[] = { 0x56, 0x00, 0x36, 0x01, 0x00 };
static const char resp_capture[] = { 0x76, 0x00, 0x36, 0x00, 0x00 };
static const char comm_data_len[] = { 0x56, 0x00, 0x34, 0x01, 0x00 };
static const char resp_data_len[] = { 0x76, 0x00, 0x34, 0x00, 0x04, 0x00, 0x00, VARP, VARP };
-static const char comm_read_data[] = { 0x56, 0x00, 0x32, 0x0C, 0x00, 0x00, 0x00, 0x00, VARP, VARP, 0x00, 0x00, VARP, VARP, 0x30, 0x00 };
+static const char comm_read_data[] = { 0x56, 0x00, 0x32, 0x0C, 0x00, 0x0F, 0x00, 0x00, VARP, VARP, 0x00, 0x00, VARP, VARP, 0x30, 0x00 };
static const char resp_read_data[] = { 0x76, 0x00, 0x32, 0x00, 0x00 };
static const char comm_stop_cap[] = { 0x56, 0x00, 0x36, 0x01, 0x03 };
static const char resp_stop_cap[] = { 0x76, 0x00, 0x36, 0x00, 0x00 };
@@ -55,7 +57,12 @@ static size_t size(const char* a) {
return 0;
}
+/*
+ * UART settings
+ */
+
static void init_uart() {
+ // HS_UART
uart_config_t uart_config = {
.baud_rate = 115200,
.data_bits = UART_DATA_8_BITS,
@@ -76,20 +83,176 @@ static void init_uart() {
uart_flush(UART_NUM);
}
-static void init_camera() {
- vTaskDelay(2500 / portTICK_PERIOD_MS);
-}
-
-static void fully_flush_uart() {
- vTaskDelay(100 / portTICK_PERIOD_MS);
+static void dynamic_flush_uart() {
+ wait(500);
size_t length;
+ ESP_ERROR_CHECK(uart_get_buffered_data_len(UART_NUM, &length));
while (length > 0) {
uart_flush(UART_NUM);
- vTaskDelay(1000 / portTICK_PERIOD_MS);
+ wait(1000);
ESP_ERROR_CHECK(uart_get_buffered_data_len(UART_NUM, &length));
}
}
+static void fully_flush_uart() {
+ dynamic_flush_uart();
+}
+
+/*
+ * Camera special
+ */
+
+static void init_camera() {
+ vTaskDelay(2500 / portTICK_PERIOD_MS);
+}
+
+/*
+ * UART communiction
+ */
+
+static enum COMMAND {
+ GEN_VERSION = 0x11,
+ SYSTEM_RESET = 0x26,
+ READ_FBUF = 0x32,
+ GET_FBUF_LEN = 0x34,
+ FBUF_CTRL = 0x36
+};
+
+void debug_print(const char* prepend, char* message, size_t size) {
+ printf("%s: ", prepend);
+ for (int i = 0; i < size; i++) {
+ printf("%X ", message[i]);
+ }
+ printf("\n");
+}
+
+static void send(enum COMMAND comm_byte, char data_lengths, char data[16]) {
+ char command[20] = { 0x56, serial_num, comm_byte, data_lengths, };
+ for (int i = 0; i < data_lengths; i++)
+ command[4 + i] = data[i];
+ debug_print("send", command, 4+data_lengths);
+
+ uart_write_bytes(UART_NUM, command, 4 + data_lengths);
+ ESP_ERROR_CHECK(uart_wait_tx_done(UART_NUM, 100));
+}
+
+#define byte_check(varname, compare) esp_err_t varname = (compare) ? ESP_OK : ESP_ERR_INVALID_RESPONSE; \
+ ESP_ERROR_CHECK(varname);
+
+static void recv(enum COMMAND comm_byte, char expectedDataSize, char ack[21]) {
+ uart_read_bytes(UART_NUM, ack, 5 + expectedDataSize, 100);
+ ESP_ERROR_CHECK(uart_wait_tx_done(UART_NUM, 100));
+ debug_print("recv", ack, 5+expectedDataSize);
+
+ byte_check(BAD_RETURN_SIGN, ack[0] == 0x76);
+ byte_check(BAD_SERIAL_NUM, ack[1] == serial_num);
+ byte_check(BAD_RETURN_COMMAND, ack[2] == comm_byte);
+ byte_check(BAD_RETURN_STATUS, ack[3] == 0);
+ // ack[4] is data-lengths
+}
+
+/*
+ * Command implementation
+ */
+
+static char temp_ack[21], temp_data[16];
+
+void ptc06_system_reset() {
+ dynamic_flush_uart(); // ignore "basic configuration information"
+ send(SYSTEM_RESET, 0, NULL);
+ recv(SYSTEM_RESET, 0, temp_ack);
+ wait(20);
+ dynamic_flush_uart(); // ignore "basic configuration information"
+}
+
+enum control_flag {
+ stop_current_frame = 0,
+ stop_next_frame = 1,
+ resume_frame = 2,
+ step_frame = 3
+};
+void ptc06_fbuf_ctrl(enum control_flag cf_byte) {
+ temp_data[0] = cf_byte;
+ send(FBUF_CTRL, 0x01, temp_data);
+ recv(FBUF_CTRL, 0, temp_ack);
+}
+
+enum fbuf_type {
+ current_frame = 0,
+ next_frame = 1
+};
+void ptc06_get_fbuf_len(enum fbuf_type type_byte) {
+ temp_data[0] = type_byte;
+ send(GET_FBUF_LEN, 0x01, temp_data);
+ recv(GET_FBUF_LEN, 4, temp_ack);
+}
+
+#define min(a, b) (a < b) ? (a) : (b)
+
+enum control_mode {
+ mcu = 0xFE,
+ dma = 0x0A
+};
+size_t ptc06_read_fbuf(enum fbuf_type type_byte, enum control_mode cm_byte, char start[4], char data_length[4], char delay[2], char** image) {
+ temp_data[0] = type_byte;
+ temp_data[1] = cm_byte;
+ for (int i = 0; i < 4; i++)
+ temp_data[2+i] = start[i];
+ for (int i = 0; i < 4; i++)
+ temp_data[6+i] = data_length[i];
+ temp_data[10] = delay[0];
+ temp_data[11] = delay[1];
+
+ size_t delayby = (delay[0] << 8) | delay[1];
+ size_t length = (data_length[2] << 8) | data_length[3];
+ printf("%d\n", length);
+
+ *image = (char*)malloc(length);
+ memset(*image, 0xFA, length);
+
+ send(READ_FBUF, 0x0C, temp_data);
+
+ recv(READ_FBUF, 0, temp_ack);
+ wait(delayby * 0.01 * 2);
+
+ size_t current = 0;
+ size_t available = 1;
+ while (current < length) {
+ ESP_ERROR_CHECK(uart_get_buffered_data_len(UART_NUM, &available));
+ size_t old = current;
+ current += uart_read_bytes(UART_NUM, *image + current, min(available, length - current), 500);
+ debug_print("image", *image + old, current - old);
+ printf("%d %d\n", current, available);
+ ESP_ERROR_CHECK(uart_wait_tx_done(UART_NUM, 500));
+ wait(20);
+ }
+
+ wait(delayby * 0.01 * 2);
+ recv(READ_FBUF, 0, temp_ack);
+
+ return length;
+}
+
+
+
+void ptc06_reset() {
+ ptc06_system_reset();
+}
+
+size_t ptc06_shoot_photo(char** image) {
+ ptc06_fbuf_ctrl(stop_current_frame);
+ wait(1000);
+ ptc06_get_fbuf_len(current_frame);
+ char start[4] = { 0x00 };
+ char delay[2] = { 0x30, 0x00 };
+ size_t length = ptc06_read_fbuf(current_frame, dma, start, temp_ack + 5, delay, image);
+ ptc06_fbuf_ctrl(resume_frame);
+ return length;
+}
+
+
+
+
#include <stdio.h>
static bool resp_eq(const char a[], size_t sizea, const char b[], size_t sizeb) {
@@ -153,12 +316,12 @@ static void recv_ack(const char ack[]) {
recv_ackXXYY(ack, NULL, NULL);
}
-void ptc06_reset() {
- fully_flush_uart();
- send_comm(comm_reset);
- recv_ack(resp_reset);
- fully_flush_uart();
-}
+/* void ptc06_reset() { */
+/* fully_flush_uart(); */
+/* send_comm(comm_reset); */
+/* recv_ack(resp_reset); */
+/* fully_flush_uart(); */
+/* } */
static void ptc06_set_resolution() {
char res[] = { 0x22 };
@@ -188,8 +351,6 @@ static void ptc06_read_image_length(char* XX, char* YY) {
ESP_LOGI(TAG, "Read length");
}
-#define min(a, b) a < b ? a : b
-
static char* ptc06_read_image_data(const char XX, const char YY) {
size_t length = (XX << 8) | YY;
char* image = (char*)malloc(length * sizeof(char));
@@ -234,14 +395,14 @@ void ptc06_init() {
/* ptc06_set_resolution(); */
/* ptc06_set_compressibility(); */
- ESP_LOGI(TAG, "Initialized ptc06 successfully. UART tx: %d, rx: %d, rts: %d, cts: %d", UART_TX, UART_RX, UART_RTS, UART_CTS);
+ ESP_LOGI(TAG, "Initialized ptc06 successfully. UART tx: %d, rx: %d", UART_TX, UART_RX);
}
-char* ptc06_shoot_photo() {
- ptc06_capture();
- char XX, YY;
- ptc06_read_image_length(&XX, &YY);
- char* img = ptc06_read_image_data(XX, YY);
- ptc06_stop_capture();
- return img;
-}
+/* char* ptc06_shoot_photo() { */
+/* ptc06_capture(); */
+/* char XX, YY; */
+/* ptc06_read_image_length(&XX, &YY); */
+/* char* img = ptc06_read_image_data(XX, YY); */
+/* ptc06_stop_capture(); */
+/* return img; */
+/* } */
diff --git a/Year 3/Internet of things/goam/main/ptc06.h b/Year 3/Internet of things/goam/main/ptc06.h
index 631ba7a..f9b00cb 100644
--- a/Year 3/Internet of things/goam/main/ptc06.h
+++ b/Year 3/Internet of things/goam/main/ptc06.h
@@ -2,4 +2,4 @@
void ptc06_init();
void ptc06_reset();
-char* ptc06_shoot_photo();
+size_t ptc06_shoot_photo(char** image);