diff options
| Commit | 58c66096783cb51ac8b7df846c383135f765f4f1 (patch) | |
|---|---|---|
| Author | 2024-05-05 11:24:54 +0300 | |
| Committer | 2024-05-05 11:24:54 +0300 | |
| Files | f4c5f4883e02a58664db3e6436c295f64ef9af65 | |
| uni-projects-58c66096783cb51ac8b7df846c383135f765f4f1.tar uni-projects-58c66096783cb51ac8b7df846c383135f765f4f1.tar.gz uni-projects-58c66096783cb51ac8b7df846c383135f765f4f1.zip | ||
| Parent | fb789d59604ae4141cf56981beec4293b235f55b (diff) | |
[iot/goam] Successful but ugly image reading
3 files changed, 198 insertions, 30 deletions
| -rw-r--r-- | Year 3/Internet of things/goam/main/main.c | 11 | ||||
| -rw-r--r-- | Year 3/Internet of things/goam/main/ptc06.c | 215 | ||||
| -rw-r--r-- | Year 3/Internet of things/goam/main/ptc06.h | 2 |
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); |
