From 2870d4685ebdb92d2c401e1f4efeaaa7e14457b3 Mon Sep 17 00:00:00 2001 From: Qukich Date: Thu, 22 Feb 2024 10:36:10 +0300 Subject: [PATCH] fix and add main.c --- main_sketch/Lcd_print.cpp | 99 +++++++++++ main_sketch/MyLCD.h | 22 +++ main_sketch/circular_buf.c | 36 ++++ main_sketch/circular_buf.h | 18 ++ main_sketch/client.c | 129 +++++++++++++++ main_sketch/client.h | 49 ++++++ main_sketch/fcs.c | 41 +++++ main_sketch/fcs.h | 18 ++ main_sketch/hdlc.c | 262 ++++++++++++++++++++++++++++++ main_sketch/hdlc.h | 108 ++++++++++++ main_sketch/i2cmaster.h | 42 +++++ main_sketch/keywords.txt | 10 ++ main_sketch/lcd.h | 8 + main_sketch/lcdpcf8574.cpp | 316 ++++++++++++++++++++++++++++++++++++ main_sketch/lcdpcf8574.h | 110 +++++++++++++ main_sketch/main.c | 120 ++++++++++++++ main_sketch/main_sketch.ino | 108 ++++++++++++ main_sketch/pcf8574.cpp | 115 +++++++++++++ main_sketch/pcf8574.h | 21 +++ main_sketch/protocol.c | 56 +++++++ main_sketch/protocol.h | 32 ++++ main_sketch/timer.c | 21 +++ main_sketch/timer.h | 7 + main_sketch/twimaster.cpp | 117 +++++++++++++ 24 files changed, 1865 insertions(+) create mode 100644 main_sketch/Lcd_print.cpp create mode 100644 main_sketch/MyLCD.h create mode 100644 main_sketch/circular_buf.c create mode 100644 main_sketch/circular_buf.h create mode 100644 main_sketch/client.c create mode 100644 main_sketch/client.h create mode 100644 main_sketch/fcs.c create mode 100644 main_sketch/fcs.h create mode 100644 main_sketch/hdlc.c create mode 100644 main_sketch/hdlc.h create mode 100644 main_sketch/i2cmaster.h create mode 100644 main_sketch/keywords.txt create mode 100644 main_sketch/lcd.h create mode 100644 main_sketch/lcdpcf8574.cpp create mode 100644 main_sketch/lcdpcf8574.h create mode 100644 main_sketch/main.c create mode 100644 main_sketch/main_sketch.ino create mode 100644 main_sketch/pcf8574.cpp create mode 100644 main_sketch/pcf8574.h create mode 100644 main_sketch/protocol.c create mode 100644 main_sketch/protocol.h create mode 100644 main_sketch/timer.c create mode 100644 main_sketch/timer.h create mode 100644 main_sketch/twimaster.cpp diff --git a/main_sketch/Lcd_print.cpp b/main_sketch/Lcd_print.cpp new file mode 100644 index 0000000..bae875b --- /dev/null +++ b/main_sketch/Lcd_print.cpp @@ -0,0 +1,99 @@ +#include +#include +#include +#include +#include "MyLCD.h" +#include "protocol.h" +#include + +struct DisplayData { + char topLine[64]; + float value1; + float value2; + float value3; +}; + +struct TextCounter { + unsigned long startTime; + int incrementValue; +}; + +TextCounter textCounter; + +void Lcd_inciliation() { + lcd_init(LCD_DISP_ON_BLINK); // инициализация дисплея + lcd_home(); // домой курсор + lcd_led(0); // вкл подсветки + textCounter.startTime = millis(); // Запоминаем время запуска программы +} + +void fillBuffer1(const char* source, char* buffer, size_t bufferSize, int incrementValue) { + int startIndex = incrementValue % strlen(source); // Определяем начальный индекс на основе incrementValue + int endIndex = startIndex + 16; + + for (int i = 0; i < 16; ++i) { + buffer[i] = source[(startIndex + i) % strlen(source)]; + } + buffer[16] = '\0'; // Установка нулевого символа в конце буфера +} + +void fillBuffer2(float value1, float value2, float value3, char* buffer, size_t bufferSize) { + snprintf(buffer, bufferSize, "%.2f.%.2f.%.2f", value1, value2, value3); +} + +void printLcd(struct message* decode_message) { + unsigned long currentTime = millis(); // Текущее время + // Проверяем, прошло ли 500 мс с момента последнего увеличения incrementValue + if (currentTime - textCounter.startTime >= 500) { + textCounter.incrementValue++; // Увеличиваем incrementValue на 1 + textCounter.startTime = currentTime; // Обновляем время + } + + struct DisplayData displayData; + strncpy(displayData.topLine, decode_message->str, sizeof(displayData.topLine) - 1); + displayData.topLine[sizeof(displayData.topLine) - 1] = '\0'; + displayData.value1 = decode_message->numbers[0]; + displayData.value2 = decode_message->numbers[1]; + displayData.value3 = decode_message->numbers[2]; + + // Буферы для заполнения данных + char buffer1[17]; + char buffer2[17]; + + // Заполнение буфера 1 + fillBuffer1(displayData.topLine, buffer1, sizeof(buffer1), textCounter.incrementValue); + + // Заполнение буфера 2 + fillBuffer2(displayData.value1, displayData.value2, displayData.value3, buffer2, sizeof(buffer2)); + + // Создание массива для вывода на дисплей + char displayArray[32]; + strncpy(displayArray, buffer1, 16); // Копирование первых 16 символов из buffer1 в displayArray + strncpy(displayArray + 16, buffer2, 16); // Копирование первых 16 символов из buffer2 в displayArray, начиная с позиции 16 + + // Вывод данных на экран + lcd_gotoxy(0, 0); + lcd_puts(displayArray); + + lcd_gotoxy(0, 1); + lcd_puts(displayArray + 16); // Вывод второй половины displayArray +} + +void dder() { + Lcd_inciliation(); + + uint8_t encode_message[100]; + size_t len_encode_message = 0; + struct message message; + + + // Получаем данные из протокола + protocol_encode(message, encode_message, &len_encode_message); + + // Декодируем данные из протокола + struct message decode_message; + protocol_decode(encode_message, len_encode_message, &decode_message); + + // Выводим данные на экран + printLcd(&decode_message); +} \ No newline at end of file diff --git a/main_sketch/MyLCD.h b/main_sketch/MyLCD.h new file mode 100644 index 0000000..f9d17f9 --- /dev/null +++ b/main_sketch/MyLCD.h @@ -0,0 +1,22 @@ + +#ifndef MYLCD_H_ +#define MYLCD_H_ + + +// ���������� ��� ���� +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "lcdpcf8574.h" +#include "pcf8574.h" +#include "i2cmaster.h" + + +#endif \ No newline at end of file diff --git a/main_sketch/circular_buf.c b/main_sketch/circular_buf.c new file mode 100644 index 0000000..e1b91c7 --- /dev/null +++ b/main_sketch/circular_buf.c @@ -0,0 +1,36 @@ +#include +#include +#include "circular_buf.h" + + +void initialize_buffer(struct circular_buffer* cb) { + cb->buf_head = 0; + cb->buf_tail = 0; +} +// Проверка, пустой ли буфер +int buffer_empty(const struct circular_buffer* cb) { + return cb->buf_head == cb->buf_tail; +} +// Проверка, заполнен ли буфер +int buffer_full(const struct circular_buffer* cb) { + return (cb->buf_tail + 1) % BUFFER_SIZE == cb->buf_head; //проверяем следующее число, если оно будет совпадать с индексом головы то будет false, при совпадении вывод true +} +// Запись в буфер +void write_buffer(struct circular_buffer* cb, int value) { + if (buffer_full(cb)) { // проверяем, заполнен ли буфер + return; + } + cb->buffer[cb->buf_tail] = value;// записываем значение в элемент массива в хвост + cb->buf_tail = (cb->buf_tail + 1) % BUFFER_SIZE;// присваивается cb->buf_tail, обновляется его значение на следующий индекс в буфере +} +// Чтение элемента +int read_buffer(struct circular_buffer* cb) { + if (buffer_empty(cb)) { // проверка на пустоту + return -1;// -1 как индикатор в случае ошибки + } + int value = cb->buffer[cb->buf_head]; // чтение по индексу головы + cb->buf_head = (cb->buf_head + 1) % BUFFER_SIZE; // увеличиваем индекс на 1 + return value; +} + + diff --git a/main_sketch/circular_buf.h b/main_sketch/circular_buf.h new file mode 100644 index 0000000..22dc139 --- /dev/null +++ b/main_sketch/circular_buf.h @@ -0,0 +1,18 @@ +#ifndef CIRCULAR_BUFFER_H +#define CIRCULAR_BUFFER_H + +#define BUFFER_SIZE 32 + +struct circular_buffer{ + unsigned char buffer[BUFFER_SIZE]; + unsigned char buf_head; + unsigned char buf_tail; +}; + +void initialize_buffer(struct circular_buffer* cb); +int buffer_empty(const struct circular_buffer* cb); +int buffer_full(const struct circular_buffer* cb); +void write_buffer(struct circular_buffer* cb, int value); +int read_buffer(struct circular_buffer* cb); + +#endif /* CIRCULAR_BUFFER_H */ diff --git a/main_sketch/client.c b/main_sketch/client.c new file mode 100644 index 0000000..b2b7318 --- /dev/null +++ b/main_sketch/client.c @@ -0,0 +1,129 @@ +#include "client.h" +#include "hdlc.h" +#include "stdio.h" + +#define SIZE_DATA_BUFFERS 64 + +int connecting_frame_timeout_bf; + +void init_hdlc_client(struct Client* client, int connecting_frame_timeout){ + client->state = IDLE_STATE; + client->connecting_frame_timeout = connecting_frame_timeout; + connecting_frame_timeout_bf = connecting_frame_timeout; + client->current_index_frame = 20; + + client->current_state_hdlc.control_escape = 0; + client->current_state_hdlc.fcs = FCS_INIT_VALUE; + client->current_state_hdlc.start_index = -1; + client->current_state_hdlc.end_index = -1; + client->current_state_hdlc.src_index = 0; + client->current_state_hdlc.dest_index = 0; +} + +void hdlc_connect(struct Client* client){ + client->state = CONNECTING; + + client->frameS.seq_no = 0; + client->frameS.frame = S_FRAME; + client->current_index_frame = client->frameS.seq_no; +} + +int hdlc_send_data(struct Client* client, uint8_t data[], size_t data_len){ + if (client->state != READY_STATE){ + return ERR_INVALID_STATE; + } + + client->state = RECIVING; + + if (SIZE_DATA_BUFFERS < data_len){ + return ERR_INVALID_DATA_SIZE; + } + + client->frameI.seq_no = 0; + client->frameI.frame = I_FRAME; + client->data_i_frame = data; + client->len_data_i_frame = data_len; + client->current_index_frame = client->frameI.seq_no; + + client->state = RECIVING; + return 0; +} + +int hdlc_get_raw_frame(struct Client *client, uint8_t* buffer, size_t lenBuffer) { + if(client->state == RECIVING){ + int ret = hdlc_frame_data(&client->frameI, client->data_i_frame, + client->len_data_i_frame, buffer, &lenBuffer); + if (ret < 0){ + printf("err in get_frame: %d\n", ret); + } + } + + if (client->state == CONNECTING){ + int ret = hdlc_frame_data(&client->frameS, NULL, 0, buffer, &lenBuffer); + + if (ret < 0){ + printf("err in get_frame: %d\n", ret); + } + } + + if (client->state == DISCONNECTING){ + int ret = hdlc_frame_data(&client->frame_rej, NULL, 0, buffer, &lenBuffer); + + if (ret < 0){ + printf("err in get_frame: %d\n", ret); + } + } + + return 0; +} + +int hdlc_decode_recived_raw_data(struct Client* client, uint8_t* buffer, size_t len_buffer, uint8_t* recived_data, size_t* len_recived_data){ + hdlc_control_t recv_control; + uint8_t recive[len_buffer]; + + int ret = hdlc_get_data_with_state(&client->current_state_hdlc,&recv_control, buffer, len_buffer, recive, + &len_buffer); + + if (ret < 0) { + return ret; + } + + if (recv_control.seq_no != client->current_index_frame){ + client->state = DISCONNECTING; + client->frame_rej.seq_no = 0; + client->frame_rej.frame = S_FRAME_NACK; + return ERR_INVALID_SEQ_NUMBER_FRAME; + } + + switch (recv_control.frame) { + case S_FRAME: + client->state = READY_STATE; + break; + case I_FRAME: + for (int i = 0; i < sizeof(recive)-2; i++){ + recived_data[i] = recive[i]; + } + + *len_recived_data = sizeof(recive)-2; + + client->state = SEND; + break; + case S_FRAME_NACK: + client->state = DISCONNECTING; + client->frame_rej.seq_no = 0; + client->frame_rej.frame = S_FRAME_NACK; + return ERR_INVALID_SEQ_NUMBER_FRAME; + } + + client->connecting_frame_timeout = connecting_frame_timeout_bf; + return 0; +} + +int hdlc_timeout_handler(struct Client* client, int delta_time){ + client->connecting_frame_timeout -= delta_time; + + if (client->connecting_frame_timeout <= 0){ + return ERR_FRAME_TIME_OUT; + } + return 0; +} \ No newline at end of file diff --git a/main_sketch/client.h b/main_sketch/client.h new file mode 100644 index 0000000..8702fa1 --- /dev/null +++ b/main_sketch/client.h @@ -0,0 +1,49 @@ +#ifndef CLIENT_H +#define CLIENT_H + +#include +#include +#include "hdlc.h" + +#define ERR_INVALID_DATA_SIZE -1 +#define ERR_ALL_BUFFERS_FILL -2 +#define ERR_INVALID_PARAMS -3 +#define ERR_INVALID_STATE -4 +#define ERR_FRAME_TIME_OUT -5 +#define ERR_INVALID_SEQ_NUMBER_FRAME -6 +#define ERR_TIMEOUT_ANSWER -7 + +enum HDLCState { + UNINITIALIZED_STATE = 0, // состояние до инцилизации + IDLE_STATE, // Состояние ожидания начала + READY_STATE, // Состояние принятия + CONNECTING, // состояние соединения + DISCONNECTING, // состояния отключения + RECIVING, // состояние приема и отправки + SEND, //данные отправлены +}; + +struct Client{ + enum HDLCState state; + int connecting_frame_timeout; //-1 + uint8_t current_index_frame; + hdlc_state_t current_state_hdlc; + hdlc_control_t frameS; + hdlc_control_t frameI; + uint8_t* data_i_frame; + size_t len_data_i_frame; +// hdlc_control_t frame3; +// hdlc_control_t frame4; + hdlc_control_t frame_rej; +}; + +//название функций +void init_hdlc_client(struct Client* client, int connecting_frame_timeout); +void hdlc_connect(struct Client* client); +int hdlc_send_data(struct Client* client, uint8_t data[], size_t data_len); +int hdlc_get_raw_frame(struct Client *client, uint8_t* buffer, size_t lenBuffer); +//принимает буффер с уарта +int hdlc_decode_recived_raw_data(struct Client* client, uint8_t* buffer, size_t len_buffer, uint8_t* recived_data, size_t* len_recived_data); +int hdlc_timeout_handler(struct Client* client, int delta_time); + +#endif //CLIENT_H diff --git a/main_sketch/fcs.c b/main_sketch/fcs.c new file mode 100644 index 0000000..6e29cf8 --- /dev/null +++ b/main_sketch/fcs.c @@ -0,0 +1,41 @@ +#include "fcs.h" + +/* + * CRC-Type: CRC16 CCIT + * Polynomial: 0x1021 (x^16+x^12+x^5+1) + * Lookup Table: Reflected + */ +static const unsigned short fcstab[256] = { + 0x0000, 0x1189, 0x2312, 0x329b, + 0x4624, 0x57ad, 0x6536, 0x74bf, 0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, + 0xdbe5, 0xe97e, 0xf8f7, 0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, + 0x75b7, 0x643e, 0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, + 0xe876, 0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd, + 0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5, 0x3183, + 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c, 0xbdcb, 0xac42, + 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974, 0x4204, 0x538d, 0x6116, + 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb, 0xce4c, 0xdfc5, 0xed5e, 0xfcd7, + 0x8868, 0x99e1, 0xab7a, 0xbaf3, 0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, + 0x0528, 0x37b3, 0x263a, 0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, + 0xbbfb, 0xaa72, 0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, + 0x17b9, 0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1, + 0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738, 0xffcf, + 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70, 0x8408, 0x9581, + 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7, 0x0840, 0x19c9, 0x2b52, + 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff, 0x9489, 0x8500, 0xb79b, 0xa612, + 0xd2ad, 0xc324, 0xf1bf, 0xe036, 0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, + 0x4f6c, 0x7df7, 0x6c7e, 0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, + 0xc03c, 0xd1b5, 0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, + 0x5dfd, 0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134, + 0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c, 0xc60c, + 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3, 0x4a44, 0x5bcd, + 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb, 0xd68d, 0xc704, 0xf59f, + 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232, 0x5ac5, 0x4b4c, 0x79d7, 0x685e, + 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a, 0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, + 0xb0a3, 0x8238, 0x93b1, 0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, + 0x0e70, 0x1ff9, 0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, + 0x8330, 0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78 }; + +FCS_SIZE calc_fcs(FCS_SIZE fcs, unsigned char value) { + return (fcs >> 8) ^ fcstab[(fcs ^ value) & 0xff]; +} \ No newline at end of file diff --git a/main_sketch/fcs.h b/main_sketch/fcs.h new file mode 100644 index 0000000..6673d40 --- /dev/null +++ b/main_sketch/fcs.h @@ -0,0 +1,18 @@ +#ifndef FCS_H +#define FCS_H + +#define FCS_INIT_VALUE 0xFFFF /* FCS initialization value. */ +#define FCS_GOOD_VALUE 0xF0B8 /* FCS value for valid frames. */ +#define FCS_INVERT_MASK 0xFFFF /* Invert the FCS value accordingly to the specification */ +#define FCS_SIZE unsigned short + +/** + * Calculates a new FCS based on the current value and value of data. + * + * @param fcs Current FCS value + * @param value The value to be added + * @returns Calculated FCS value + */ +FCS_SIZE calc_fcs(FCS_SIZE fcs, unsigned char value); + +#endif \ No newline at end of file diff --git a/main_sketch/hdlc.c b/main_sketch/hdlc.c new file mode 100644 index 0000000..a5792e5 --- /dev/null +++ b/main_sketch/hdlc.c @@ -0,0 +1,262 @@ +#include "hdlc.h" + +// HDLC Control field bit positions +#define HDLC_CONTROL_S_OR_U_FRAME_BIT 0 +#define HDLC_CONTROL_SEND_SEQ_NO_BIT 1 +#define HDLC_CONTROL_S_FRAME_TYPE_BIT 2 +#define HDLC_CONTROL_POLL_BIT 4 +#define HDLC_CONTROL_RECV_SEQ_NO_BIT 5 + +// HDLC Control type definitions +#define HDLC_CONTROL_TYPE_RECEIVE_READY 0 +#define HDLC_CONTROL_TYPE_RECEIVE_NOT_READY 1 +#define HDLC_CONTROL_TYPE_REJECT 2 +#define HDLC_CONTROL_TYPE_SELECTIVE_REJECT 3 + +static hdlc_state_t hdlc_state = { + .control_escape = 0, + .fcs = FCS_INIT_VALUE, + .start_index = -1, + .end_index = -1, + .src_index = 0, + .dest_index = 0, +}; + +int hdlc_set_state(hdlc_state_t *state) { + if (!state) { + return -EINVAL; + } + + hdlc_state = *state; + return 0; +} + + +int hdlc_get_state(hdlc_state_t *state) { + if (!state) { + return -EINVAL; + } + + *state = hdlc_state; + return 0; +} + +void hdlc_escape_value(char value, char *dest, int *dest_index) { + // Check and escape the value if needed + if ((value == HDLC_FLAG_SEQUENCE) || (value == HDLC_CONTROL_ESCAPE)) { + dest[(*dest_index)++] = HDLC_CONTROL_ESCAPE; + value ^= 0x20; + } + + // Add the value to the destination buffer and increment destination index + dest[(*dest_index)++] = value; +} + +hdlc_control_t hdlc_get_control_type(unsigned char control) { + hdlc_control_t value; + + // Check if the frame is a S-frame (or U-frame) + if (control & (1 << HDLC_CONTROL_S_OR_U_FRAME_BIT)) { + // Check if S-frame type is a Receive Ready (ACK) + if (((control >> HDLC_CONTROL_S_FRAME_TYPE_BIT) & 0x3) + == HDLC_CONTROL_TYPE_RECEIVE_READY) { + value.frame = S_FRAME; + } else { + // Assume it is an NACK since Receive Not Ready, Selective Reject and U-frames are not supported + value.frame = S_FRAME_NACK; + } + + // Add the receive sequence number from the S-frame (or U-frame) + value.seq_no = (control >> HDLC_CONTROL_RECV_SEQ_NO_BIT); + } else { + // It must be an I-frame so add the send sequence number (receive sequence number is not used) + value.frame = I_FRAME; + value.seq_no = (control >> HDLC_CONTROL_SEND_SEQ_NO_BIT); + } + + return value; +} + +unsigned char hdlc_frame_control_type(hdlc_control_t *control) { + unsigned char value = 0; + + switch (control->frame) { + case I_FRAME: + // Create the HDLC I-frame control byte with Poll bit set + value |= (control->seq_no << HDLC_CONTROL_SEND_SEQ_NO_BIT); + value |= (1 << HDLC_CONTROL_POLL_BIT); + break; + case S_FRAME: + // Create the HDLC Receive Ready S-frame control byte with Poll bit cleared + value |= (control->seq_no << HDLC_CONTROL_RECV_SEQ_NO_BIT); + value |= (1 << HDLC_CONTROL_S_OR_U_FRAME_BIT); + break; + case S_FRAME_NACK: + // Create the HDLC Receive Ready S-frame control byte with Poll bit cleared + value |= (control->seq_no << HDLC_CONTROL_RECV_SEQ_NO_BIT); + value |= (HDLC_CONTROL_TYPE_REJECT << HDLC_CONTROL_S_FRAME_TYPE_BIT); + value |= (1 << HDLC_CONTROL_S_OR_U_FRAME_BIT); + break; + } + + return value; +} + +void hdlc_get_data_reset() { + hdlc_get_data_reset_with_state(&hdlc_state); +} + +void hdlc_get_data_reset_with_state(hdlc_state_t *state) { + state->fcs = FCS_INIT_VALUE; + state->start_index = state->end_index = -1; + state->src_index = state->dest_index = 0; + state->control_escape = 0; +} + +//int hdlc_get_data(hdlc_control_t *control, const char *src, +// unsigned int src_len, char *dest, unsigned int *dest_len) +int hdlc_get_data(hdlc_control_t *control, uint8_t *src, + size_t src_len, uint8_t *dest, size_t *dest_len){ + return hdlc_get_data_with_state(&hdlc_state, control, src, src_len, dest, dest_len); +} + +//int hdlc_get_data_with_state(hdlc_state_t *state, hdlc_control_t *control, const char *src, +// unsigned int src_len, char *dest, unsigned int *dest_len) +int +hdlc_get_data_with_state(hdlc_state_t *state, hdlc_control_t *control, uint8_t *src, + size_t src_len, uint8_t *dest, size_t *dest_len){ + int ret; + char value; + unsigned int i; + + // Make sure that all parameters are valid + if (!state || !control || !src || !dest || !dest_len) { + return -EINVAL; + } + + // Run through the data bytes + for (i = 0; i < src_len; i++) { + // First find the start flag sequence + if (state->start_index < 0) { + if (src[i] == HDLC_FLAG_SEQUENCE) { + // Check if an additional flag sequence byte is present + if ((i < (src_len - 1)) && (src[i + 1] == HDLC_FLAG_SEQUENCE)) { + // Just loop again to silently discard it (accordingly to HDLC) + continue; + } + + state->start_index = state->src_index; + } + } else { + // Check for end flag sequence + if (src[i] == HDLC_FLAG_SEQUENCE) { + // Check if an additional flag sequence byte is present or earlier received + if (((i < (src_len - 1)) && (src[i + 1] == HDLC_FLAG_SEQUENCE)) + || ((state->start_index + 1) == state->src_index)) { + // Just loop again to silently discard it (accordingly to HDLC) + continue; + } + + state->end_index = state->src_index; + break; + } else if (src[i] == HDLC_CONTROL_ESCAPE) { + state->control_escape = 1; + } else { + // Update the value based on any control escape received + if (state->control_escape) { + state->control_escape = 0; + value = src[i] ^ 0x20; + } else { + value = src[i]; + } + + // Now update the FCS value + state->fcs = calc_fcs(state->fcs, value); + + if (state->src_index == state->start_index + 2) { + // Control field is the second byte after the start flag sequence + *control = hdlc_get_control_type(value); + } else if (state->src_index > (state->start_index + 2)) { + // Start adding the data values after the Control field to the buffer + dest[state->dest_index++] = value; + } + } + } + state->src_index++; + } + + // Check for invalid frame (no start or end flag sequence) + if ((state->start_index < 0) || (state->end_index < 0)) { + // Return no message and make sure destination length is 0 + *dest_len = 0; + ret = -ENOMSG; + } else { + // A frame is at least 4 bytes in size and has a valid FCS value + if ((state->end_index < (state->start_index + 4)) + || (state->fcs != FCS_GOOD_VALUE)) { + // Return FCS error and indicate that data up to end flag sequence in buffer should be discarded + *dest_len = i; + ret = -EIO; + } else { + // Return success and indicate that data up to end flag sequence in buffer should be discarded + *dest_len = state->dest_index - sizeof(state->fcs); + ret = i; + } + + // Reset values for next frame + hdlc_get_data_reset_with_state(state); + } + + return ret; +} + +//int hdlc_frame_data(hdlc_control_t *control, const char *src, +// unsigned int src_len, char *dest, unsigned int *dest_len) +int hdlc_frame_data(hdlc_control_t *control, uint8_t *src, + size_t src_len, uint8_t *dest, size_t *dest_len){ + unsigned int i; + int dest_index = 0; + unsigned char value = 0; + FCS_SIZE fcs = FCS_INIT_VALUE; + + // Make sure that all parameters are valid + if (!control || (!src && (src_len > 0)) || !dest || !dest_len) { + return -EINVAL; + } + + // Start by adding the start flag sequence + dest[dest_index++] = HDLC_FLAG_SEQUENCE; + + // Add the all-station address from HDLC (broadcast) + fcs = calc_fcs(fcs, HDLC_ALL_STATION_ADDR); + hdlc_escape_value(HDLC_ALL_STATION_ADDR, dest, &dest_index); + + // Add the framed control field value + value = hdlc_frame_control_type(control); + fcs = calc_fcs(fcs, value); + hdlc_escape_value(value, dest, &dest_index); + + // Only DATA frames should contain data + if (control->frame == I_FRAME) { + // Calculate FCS and escape data + for (i = 0; i < src_len; i++) { + fcs = calc_fcs(fcs, src[i]); + hdlc_escape_value(src[i], dest, &dest_index); + } + } + + // Invert the FCS value accordingly to the specification + fcs ^= FCS_INVERT_MASK; + + // Run through the FCS bytes and escape the values + for (i = 0; i < sizeof(fcs); i++) { + value = ((fcs >> (8 * i)) & 0xFF); + hdlc_escape_value(value, dest, &dest_index); + } + + // Add end flag sequence and update length of frame + dest[dest_index++] = HDLC_FLAG_SEQUENCE; + *dest_len = dest_index; + + return 0; +} \ No newline at end of file diff --git a/main_sketch/hdlc.h b/main_sketch/hdlc.h new file mode 100644 index 0000000..61fc74a --- /dev/null +++ b/main_sketch/hdlc.h @@ -0,0 +1,108 @@ +// +// Created by 79513 on 15.12.2023. +// + +#ifndef HDLC_H +#define HDLC_H + +#include "fcs.h" +#include "errno.h" +#include "stdint.h" + +/** HDLC start/end flag sequence */ +#define HDLC_FLAG_SEQUENCE 0x7E + +/** HDLC control escape value */ +#define HDLC_CONTROL_ESCAPE 0x7D + +/** HDLC all station address */ +#define HDLC_ALL_STATION_ADDR 0xFF + +/** Supported HDLC frame types */ +typedef enum { + I_FRAME, + S_FRAME, + S_FRAME_NACK, +} hdlc_frame_t; + +/** Control field information */ +typedef struct { + hdlc_frame_t frame; + unsigned char seq_no :3; +} hdlc_control_t; + +/** Variables used in hdlc_get_data and hdlc_get_data_with_state + * to keep track of received buffers + */ +typedef struct { + char control_escape; + FCS_SIZE fcs; + int start_index; + int end_index; + int src_index; + int dest_index; +} hdlc_state_t; + +/** + * Retrieves data from specified buffer containing the HDLC frame. Frames can be + * parsed from multiple buffers e.g. when received via UART. + * + * @param[out] control Control field structure with frame type and sequence number + * @param[in] src Source buffer with frame + * @param[in] src_len Source buffer length + * @param[out] dest Destination buffer (should be able to contain max frame size) + * @param[out] dest_len Destination buffer length + * @retval >=0 Success (size of returned value should be discarded from source buffer) + * @retval -EINVAL Invalid parameter + * @retval -ENOMSG Invalid message + * @retval -EIO Invalid FCS (size of dest_len should be discarded from source buffer) + * + * @see hdlc_get_data_with_state + */ +int hdlc_get_data(hdlc_control_t *control, uint8_t *src, + size_t src_len, uint8_t *dest, size_t *dest_len); + +/** + * Retrieves data from specified buffer containing the HDLC frame. Frames can be + * parsed from multiple buffers e.g. when received via UART. + * + * This function is a variation of @ref hdlc_get_data + * The difference is only in first argument: hdlc_state_t *state + * Data under that pointer is used to keep track of internal buffers. + * + * @see hdlc_get_data + */ +int hdlc_get_data_with_state(hdlc_state_t *state, hdlc_control_t *control, uint8_t *src, + size_t src_len, uint8_t *dest, size_t *dest_len); + +/** + * Resets values used in yahdlc_get_data function to keep track of received buffers + */ +void hdlc_get_data_reset(); + +/** + * This is a variation of @ref hdlc_get_data_reset + * Resets state values that are under the pointer provided as argument + * + * This function need to be called before the first call to hdlc_get_data_with_state + * when custom state storage is used. + * + * @see hdlc_get_data_reset + */ +void hdlc_get_data_reset_with_state(hdlc_state_t *state); + +/** + * Creates HDLC frame with specified data buffer. + * + * @param[in] control Control field structure with frame type and sequence number + * @param[in] src Source buffer with data + * @param[in] src_len Source buffer length + * @param[out] dest Destination buffer (should be bigger than source buffer) + * @param[out] dest_len Destination buffer length + * @retval 0 Success + * @retval -EINVAL Invalid parameter + */ +int hdlc_frame_data(hdlc_control_t *control, uint8_t *src, + size_t src_len, uint8_t *dest, size_t *dest_len); + +#endif //HDLC_H diff --git a/main_sketch/i2cmaster.h b/main_sketch/i2cmaster.h new file mode 100644 index 0000000..72efb7c --- /dev/null +++ b/main_sketch/i2cmaster.h @@ -0,0 +1,42 @@ +#ifndef _I2CMASTER_H +#define _I2CMASTER_H + +// ����, ���������� �� ������ ������ �� i2c +#define I2C_READ 1 + +// ����, ���������� �� �������� ������ �� i2c +#define I2C_WRITE 0 + +// ������� ������������ ����� � ������ +#define SCL_CLOCK 100000L + +// ������������� ���������� +void i2c_init(void); + +// �������� ������� ���� �� ���� +void i2c_stop(void); + +// �������� ������� ����� �� ���� +unsigned char i2c_start(unsigned char addr); + +// ��������� �����(����������) +unsigned char i2c_rep_start(unsigned char addr); + +// ����, ���� ������-�� ������, � ����� �������� ������� ����� �� ���� +void i2c_start_wait(unsigned char addr); + + // �������� ������ +unsigned char i2c_write(unsigned char data); + +// ������ ������ � ���������� ������� +unsigned char i2c_readAck(void); + +// ������ ������ � ����� �� ��������� �������� ������ ���� +unsigned char i2c_readNak(void); + +// ������ ������ � ���� +unsigned char i2c_read(unsigned char ack); + +// �������� ����� ������ ������ ������ ����� +#define i2c_read(ack) (ack) ? i2c_readAck() : i2c_readNak(); +#endif diff --git a/main_sketch/keywords.txt b/main_sketch/keywords.txt new file mode 100644 index 0000000..26f60da --- /dev/null +++ b/main_sketch/keywords.txt @@ -0,0 +1,10 @@ +lcd_init KEYWORD2 +lcd_clrscr KEYWORD2 +lcd_home KEYWORD2 +lcd_gotoxy KEYWORD2 +lcd_led KEYWORD2 +lcd_putc KEYWORD2 +lcd_puts KEYWORD2 +lcd_puts_p KEYWORD2 +lcd_command KEYWORD2 +lcd_data KEYWORD2 \ No newline at end of file diff --git a/main_sketch/lcd.h b/main_sketch/lcd.h new file mode 100644 index 0000000..f798ae0 --- /dev/null +++ b/main_sketch/lcd.h @@ -0,0 +1,8 @@ +#ifndef Lsd_print_h +#define Lsd_print_h +#include "protocol.h" + +void Lcd_inciliation(); +void printLcd(struct message* decode_message); + +#endif \ No newline at end of file diff --git a/main_sketch/lcdpcf8574.cpp b/main_sketch/lcdpcf8574.cpp new file mode 100644 index 0000000..c5808d5 --- /dev/null +++ b/main_sketch/lcdpcf8574.cpp @@ -0,0 +1,316 @@ +#include "MyLCD.h" + +// задержеки через асемблер +#define lcd_e_delay() __asm__ __volatile__( "rjmp 1f\n 1:" ); +#define lcd_e_toggle() toggle_e() + + +volatile uint8_t dataport = 0; + +static void toggle_e(void); + +// сама реализация задержек +static inline void _delayFourCycles(unsigned int __count) +{ + if ( __count == 0 ) + __asm__ __volatile__( "rjmp 1f\n 1:" ); + else + __asm__ __volatile__ ( + "1: sbiw %0,1" "\n\t" + "brne 1b" + : "=w" (__count) + : "0" (__count) + ); +} + +// тупа оборачиваем функцию в макрос +#define delay(us) _delayFourCycles( ( ( 1*(F_CPU/4000) )*us)/1000 ) + +// переключение пина для начала записи команды +static void toggle_e(void) +{ + pcf8574_setoutputpinhigh(LCD_PCF8574_DEVICEID, LCD_E_PIN); + lcd_e_delay(); + pcf8574_setoutputpinlow(LCD_PCF8574_DEVICEID, LCD_E_PIN); +} + + +// отправка байта для контроллера LCD +static void lcd_write(uint8_t data,uint8_t rs) +{ + if (rs) //отправка данных (RS=1, RW=0) + dataport |= _BV(LCD_RS_PIN); + else // отпрака инструкций(RS=0, RW=0) + dataport &= ~_BV(LCD_RS_PIN); + dataport &= ~_BV(LCD_RW_PIN); + pcf8574_setoutput(LCD_PCF8574_DEVICEID, dataport); + + // отправка старшего полубайта + dataport &= ~_BV(LCD_DATA3_PIN); + dataport &= ~_BV(LCD_DATA2_PIN); + dataport &= ~_BV(LCD_DATA1_PIN); + dataport &= ~_BV(LCD_DATA0_PIN); + if(data & 0x80) dataport |= _BV(LCD_DATA3_PIN); + if(data & 0x40) dataport |= _BV(LCD_DATA2_PIN); + if(data & 0x20) dataport |= _BV(LCD_DATA1_PIN); + if(data & 0x10) dataport |= _BV(LCD_DATA0_PIN); + pcf8574_setoutput(LCD_PCF8574_DEVICEID, dataport); + lcd_e_toggle(); + + // отправка младшего полубайта + dataport &= ~_BV(LCD_DATA3_PIN); + dataport &= ~_BV(LCD_DATA2_PIN); + dataport &= ~_BV(LCD_DATA1_PIN); + dataport &= ~_BV(LCD_DATA0_PIN); + if(data & 0x08) dataport |= _BV(LCD_DATA3_PIN); + if(data & 0x04) dataport |= _BV(LCD_DATA2_PIN); + if(data & 0x02) dataport |= _BV(LCD_DATA1_PIN); + if(data & 0x01) dataport |= _BV(LCD_DATA0_PIN); + pcf8574_setoutput(LCD_PCF8574_DEVICEID, dataport); + lcd_e_toggle(); + + // завершаем передачу + dataport |= _BV(LCD_DATA0_PIN); + dataport |= _BV(LCD_DATA1_PIN); + dataport |= _BV(LCD_DATA2_PIN); + dataport |= _BV(LCD_DATA3_PIN); + pcf8574_setoutput(LCD_PCF8574_DEVICEID, dataport); +} + +// чтение байта +static uint8_t lcd_read(uint8_t rs) +{ + uint8_t data; + + if (rs) // запись данных (RS=1, RW=0) + dataport |= _BV(LCD_RS_PIN); + else // запись инструкций (RS=0, RW=0) + dataport &= ~_BV(LCD_RS_PIN); + dataport |= _BV(LCD_RW_PIN); + pcf8574_setoutput(LCD_PCF8574_DEVICEID, dataport); + + pcf8574_setoutputpinhigh(LCD_PCF8574_DEVICEID, LCD_E_PIN); + lcd_e_delay(); + // чтение страшего полубайта + data = pcf8574_getoutputpin(LCD_PCF8574_DEVICEID, LCD_DATA0_PIN) << 4; + pcf8574_setoutputpinlow(LCD_PCF8574_DEVICEID, LCD_E_PIN); + + lcd_e_delay(); + + pcf8574_setoutputpinhigh(LCD_PCF8574_DEVICEID, LCD_E_PIN); + lcd_e_delay(); + // чтение младшего полубайта + data |= pcf8574_getoutputpin(LCD_PCF8574_DEVICEID, LCD_DATA0_PIN) &0x0F; + pcf8574_setoutputpinlow(LCD_PCF8574_DEVICEID, LCD_E_PIN); + + return data; +} + +// ждем пока ЖК освободится +static uint8_t lcd_waitbusy(void) + +{ + register uint8_t c; + + // ждем + while ( (c=lcd_read(0)) & (1<= LCD_START_LINE2) && (pos < LCD_START_LINE4) ) + addressCounter = LCD_START_LINE3; + else if ( (pos >= LCD_START_LINE3) && (pos < LCD_START_LINE2) ) + addressCounter = LCD_START_LINE4; + else + addressCounter = LCD_START_LINE1; +#endif + lcd_command((1<>4; + dataport |= _BV(LCD_DATA0_PIN); // _BV(LCD_FUNCTION_8BIT)>>4; + pcf8574_setoutput(LCD_PCF8574_DEVICEID, dataport); + + // дрючим дисплей чтобы он начал работать + lcd_e_toggle(); + delay(4992); + lcd_e_toggle(); + delay(64); + lcd_e_toggle(); + delay(64); + + // переходим в 4 битный режим + dataport &= ~_BV(LCD_DATA0_PIN); + pcf8574_setoutput(LCD_PCF8574_DEVICEID, dataport); + lcd_e_toggle(); + delay(64); + + + lcd_command(LCD_FUNCTION_DEFAULT); // настраиваем кол-во строк + lcd_command(LCD_DISP_OFF); // вырубаем дисплей + lcd_clrscr(); // чистим экран + lcd_command(LCD_MODE_DEFAULT); // запускаемся в стандартном режиме + lcd_command(dispAttr); // отправляем настройки +} diff --git a/main_sketch/lcdpcf8574.h b/main_sketch/lcdpcf8574.h new file mode 100644 index 0000000..cff8714 --- /dev/null +++ b/main_sketch/lcdpcf8574.h @@ -0,0 +1,110 @@ +#ifndef LCD_H +#define LCD_H + +#define LCD_PCF8574_INIT 1 //������������� pcf + +#define LCD_PCF8574_DEVICEID 0 //id ���-�� +#define LCD_FUNCTION_DEFAULT LCD_FUNCTION_4BIT_2LINES + +// ��������� ������ �����: ���������/���������� �������� �������, ����������� ����������� ������� ���������/����������� +#define LCD_ENTRY_DEC 0x04 // �������� ������� ���������, ������ ������������ �� ������� +#define LCD_ENTRY_DEC_SHIFT 0x05 // ��������� ������ �������, ����������� ������� �� ������� +#define LCD_ENTRY_INC_ 0x06 // �������� ������� ���������, ���. ����������� ������� � ����������� +#define LCD_ENTRY_INC_SHIFT 0x07 // ��������� �������� �������, ���������� ����������� ����������� ������� + +// ���������/���������� �������, ���������/���������� �������, �������� ������ � ������� ������� +#define LCD_DISP_OFF 0x08 // ������� �������� +#define LCD_DISP_ON 0x0C // ������� ���, ������ ���� +#define LCD_DISP_ON_BLINK 0x0D // ������� ���, ������ ����, ���� �������� ����� +#define LCD_DISP_ON_CURSOR 0x0E // ������� ���, ������ ��� +#define LCD_DISP_ON_CURSOR_BLINK 0x0F // ������� ���, ������ ���, ���� �������� ����� + +// ����������� �������/�������� ������� +#define LCD_MOVE_CURSOR_LEFT 0x10 // ������ ������ +#define LCD_MOVE_CURSOR_RIGHT 0x14 // ������ ������� +#define LCD_MOVE_DISP_LEFT 0x18 // ����� ����� +#define LCD_MOVE_DISP_RIGHT 0x1C // ����� ������ + +// ����� �������: ��������� ����� ������ ���������� � ���������� ����� ����������� +#define LCD_FUNCTION_4BIT_1LINE 0x20 // 4-������ ���������, ���� ������, 5x7 ����� +#define LCD_FUNCTION_4BIT_2LINES 0x28 // 4-������ ���������, ������������, 5x7 ����� +#define LCD_FUNCTION_8BIT_1LINE 0x30 // 8-������ ���������, ���� ������, 5x7 ����� +#define LCD_FUNCTION_8BIT_2LINES 0x38 // 8-������ ���������, ������������, 5x7 ����� + +#define LCD_LINES 2 // ���-�� ����� +#define LCD_DISP_LENGTH 16 // ���-�� �������� � ������ +#define LCD_LINE_LENGTH 0x40 // ���������� ����� ������ ������� +#define LCD_START_LINE1 0x00 // DDRM ����� ��� 1 ������ +#define LCD_START_LINE2 0x40 // DDRM ����� ��� 2 ������ +#define LCD_WRAP_LINES 1 // ������� ������ + + + +#define LCD_DATA0_PIN 4 // ��� ��� ������ +#define LCD_DATA1_PIN 5 // ��� ��� ������ +#define LCD_DATA2_PIN 6 // ��� ��� ������ +#define LCD_DATA3_PIN 7 // ��� ��� ������ +#define LCD_RS_PIN 0 // ��� ����� RS +#define LCD_RW_PIN 1 // ��� ����� RW +#define LCD_E_PIN 2 // ��� ����� ������������ +#define LCD_LED_PIN 3 // ��� ��������� + + +// ������� ����� �������� ������ HD44780U. +#define LCD_CLR 0 // ��������� ������� +#define LCD_HOME 1 // ������� ������ ����� +#define LCD_ENTRY_MODE 2 // ��������� ������ ����� +#define LCD_ENTRY_INC 1 // ��������� +#define LCD_ENTRY_SHIFT 0 // ��� �������� +#define LCD_ON 3 // ��� ������� +#define LCD_ON_DISPLAY 2 // ���� ������� +#define LCD_ON_CURSOR 1 // ���� ������ +#define LCD_ON_BLINK 0 // ������� ������� +#define LCD_MOVE 4 // ������������ ������� +#define LCD_MOVE_DISP 3 // ������������ ������� +#define LCD_MOVE_RIGHT 2 // ������������ ������� ������� +#define LCD_FUNCTION 5 // ��������� ������� +#define LCD_FUNCTION_8BIT 4 // 8 ������ ����� +#define LCD_FUNCTION_2LINES 3 // ��������� ����� +#define LCD_FUNCTION_10DOTS 2 // ������ +#define LCD_CGRAM 6 // ��������� ������ CG RAM +#define LCD_DDRAM 7 // ��������� ������ DD RAM +#define LCD_BUSY 7 // ������� ����� + +// ����������� ����� +#define LCD_MODE_DEFAULT ((1<= 0 && deviceid < PCF8574_MAXDEVICES)) { + data = pcf8574_pinstatus[deviceid]; + } + return data; +} + +// получаем статус пинов вывода +int8_t pcf8574_getoutputpin(uint8_t deviceid, uint8_t pin) { + int8_t data = -1; + if((deviceid >= 0 && deviceid < PCF8574_MAXDEVICES) && (pin >= 0 && pin < PCF8574_MAXPINS)) { + data = pcf8574_pinstatus[deviceid]; + data = (data >> pin) & 0b00000001; + } + return data; +} + +// настройка вывода +int8_t pcf8574_setoutput(uint8_t deviceid, uint8_t data) { + if((deviceid >= 0 && deviceid < PCF8574_MAXDEVICES)) { + pcf8574_pinstatus[deviceid] = data; + i2c_start(((PCF8574_ADDRBASE+deviceid)<<1) | I2C_WRITE); + i2c_write(data); + i2c_stop(); + return 0; + } + return -1; +} + +// установить выходные контакты, заменить фактический статус устройства из pinstart для i2c +int8_t pcf8574_setoutputpins(uint8_t deviceid, uint8_t pinstart, uint8_t pinlength, int8_t data) { + if((deviceid >= 0 && deviceid < PCF8574_MAXDEVICES) && (pinstart - pinlength + 1 >= 0 && pinstart - pinlength + 1 >= 0 && pinstart < PCF8574_MAXPINS && pinstart > 0 && pinlength > 0)) { + uint8_t b = 0; + b = pcf8574_pinstatus[deviceid]; + uint8_t mask = ((1 << pinlength) - 1) << (pinstart - pinlength + 1); + data <<= (pinstart - pinlength + 1); + data &= mask; + b &= ~(mask); + b |= data; + pcf8574_pinstatus[deviceid] = b; + //рестартим + i2c_start(((PCF8574_ADDRBASE+deviceid)<<1) | I2C_WRITE); + i2c_write(b); + i2c_stop(); + return 0; + } + return -1; +} + +// настройка пинов вывода +int8_t pcf8574_setoutputpin(uint8_t deviceid, uint8_t pin, uint8_t data) { + if((deviceid >= 0 && deviceid < PCF8574_MAXDEVICES) && (pin >= 0 && pin < PCF8574_MAXPINS)) { + uint8_t b = 0; + b = pcf8574_pinstatus[deviceid]; + b = (data != 0) ? (b | (1 << pin)) : (b & ~(1 << pin)); + pcf8574_pinstatus[deviceid] = b; + //рестартим + i2c_start(((PCF8574_ADDRBASE+deviceid)<<1) | I2C_WRITE); + i2c_write(b); + i2c_stop(); + return 0; + } + return -1; +} + +// установка высокого уровня на выходных пинах +int8_t pcf8574_setoutputpinhigh(uint8_t deviceid, uint8_t pin) { + return pcf8574_setoutputpin(deviceid, pin, 1); +} + +// установка низкого уровня на выходных пинах +int8_t pcf8574_setoutputpinlow(uint8_t deviceid, uint8_t pin) { + return pcf8574_setoutputpin(deviceid, pin, 0); +} + +// получение входных данных +int8_t pcf8574_getinput(uint8_t deviceid) { + int8_t data = -1; + if((deviceid >= 0 && deviceid < PCF8574_MAXDEVICES)) { + i2c_start(((PCF8574_ADDRBASE+deviceid)<<1) | I2C_READ); + data = ~i2c_readNak(); + i2c_stop(); + } + return data; +} + +// получение входного контакта (высокий или низкий) +int8_t pcf8574_getinputpin(uint8_t deviceid, uint8_t pin) { + int8_t data = -1; + if((deviceid >= 0 && deviceid < PCF8574_MAXDEVICES) && (pin >= 0 && pin < PCF8574_MAXPINS)) { + data = pcf8574_getinput(deviceid); + if(data != -1) { + data = (data >> pin) & 0b00000001; + } + } + return data; +} \ No newline at end of file diff --git a/main_sketch/pcf8574.h b/main_sketch/pcf8574.h new file mode 100644 index 0000000..74af505 --- /dev/null +++ b/main_sketch/pcf8574.h @@ -0,0 +1,21 @@ +#ifndef PCF8574_H_ +#define PCF8574_H_ + +#define PCF8574_ADDRBASE (0x27) // ����� ���-�� + +#define PCF8574_I2CINIT 1 // ������������� i2c + +#define PCF8574_MAXDEVICES 1 // ���� ���-�� �������� +#define PCF8574_MAXPINS 8 // ���� ���-�� ����� + +void pcf8574_init(); +int8_t pcf8574_getoutput(uint8_t deviceid); +int8_t pcf8574_getoutputpin(uint8_t deviceid, uint8_t pin); +int8_t pcf8574_setoutput(uint8_t deviceid, uint8_t data); +int8_t pcf8574_setoutputpins(uint8_t deviceid, uint8_t pinstart, uint8_t pinlength, int8_t data); +int8_t pcf8574_setoutputpin(uint8_t deviceid, uint8_t pin, uint8_t data); +int8_t pcf8574_setoutputpinhigh(uint8_t deviceid, uint8_t pin); +int8_t pcf8574_setoutputpinlow(uint8_t deviceid, uint8_t pin); +int8_t pcf8574_getinput(uint8_t deviceid); +int8_t pcf8574_getinputpin(uint8_t deviceid, uint8_t pin); +#endif diff --git a/main_sketch/protocol.c b/main_sketch/protocol.c new file mode 100644 index 0000000..9717050 --- /dev/null +++ b/main_sketch/protocol.c @@ -0,0 +1,56 @@ +#include "protocol.h" + +void protocol_decode(uint8_t encode_message[], size_t len_encode_message, struct message* decode_message){ + int count_number = 0; + for(int i = 0; i < len_encode_message; i++){ + if (encode_message[i] == FLAG_NUMBER){ + union convert_float sample; + for (int z = 0; z < sizeof sample.buf; z++){ + i++; + sample.buf[z] = encode_message[i]; + } + decode_message->numbers[count_number++] = sample.fVal; + decode_message->len_numbers++; + } + + + if (encode_message[i] == FLAG_WORD){ + int count_word = 0; + i++; + union convert_char sample; + for (int z = 0; z < encode_message[i]; z++){ + i++; + sample.buf[z] = encode_message[i]; + } + decode_message->str = sample.cVal; + decode_message->len_str = count_word; + } + } + decode_message->len_numbers = count_number; +} + +void protocol_encode(struct message message, uint8_t encode_message[], size_t* len_encode_message){ + size_t count = 0; + if (message.len_numbers > 0){ + for (int i = 0; i < message.len_numbers; i++){ + encode_message[count++] = FLAG_NUMBER; + union convert_float sample; + sample.fVal = message.numbers[i]; + for (int z = 0; z < sizeof sample.buf; z++){ + encode_message[count++] = sample.buf[z]; + } + } + } + + if (message.len_str > 0){ + encode_message[count++] = FLAG_WORD; + encode_message[count++] = message.len_str; + union convert_char sample; + sample.cVal = message.str; + for (int i = 0; i < message.len_str; i++){ + encode_message[count++] = sample.buf[i]; + } + } + + *len_encode_message = count; +} \ No newline at end of file diff --git a/main_sketch/protocol.h b/main_sketch/protocol.h new file mode 100644 index 0000000..c23f040 --- /dev/null +++ b/main_sketch/protocol.h @@ -0,0 +1,32 @@ +#ifndef PROTOCOL_H +#define PROTOCOL_H + +#include +#include +#include +#include "stdio.h" + +#define FLAG_NUMBER 0 +#define FLAG_WORD 1 + +struct message{ + float numbers[3]; + size_t len_numbers; + char* str; + size_t len_str; +}; + +union convert_float{ + float fVal; + uint8_t buf[4]; +}; + +union convert_char{ + char* cVal; + uint8_t buf[64]; +}; + +void protocol_decode(uint8_t encode_message[], size_t len_encode_message, struct message* decode_message); +void protocol_encode(struct message message, uint8_t encode_message[], size_t* len_encode_message); + +#endif //PROTOCOL_H diff --git a/main_sketch/timer.c b/main_sketch/timer.c new file mode 100644 index 0000000..ca35795 --- /dev/null +++ b/main_sketch/timer.c @@ -0,0 +1,21 @@ +#include +#include + +static volatile unsigned long timerMillis = 0; + +void timerInit() { + TCCR1B |= (1 << WGM12) | (1 << CS11) | (1 << CS10); + OCR1A = 250; + TIMSK1 |= (1 << OCIE1A); + sei(); +} + +unsigned long millis() { + unsigned long ms; + ms = timerMillis; + return ms; +} + +ISR(TIMER1_COMPA_vect) { + timerMillis++; +} \ No newline at end of file diff --git a/main_sketch/timer.h b/main_sketch/timer.h new file mode 100644 index 0000000..f5b07fe --- /dev/null +++ b/main_sketch/timer.h @@ -0,0 +1,7 @@ +#ifndef TIMER_H +#define TIMER_H + +void timerInit(); +unsigned long millis(); + +#endif // TIMER_H \ No newline at end of file diff --git a/main_sketch/twimaster.cpp b/main_sketch/twimaster.cpp new file mode 100644 index 0000000..2fad0d7 --- /dev/null +++ b/main_sketch/twimaster.cpp @@ -0,0 +1,117 @@ +#include "MyLCD.h" + +// инициализация интерфейса i2c +void i2c_init(void) +{ + // предделитель тактовой частоты равен 1 + TWSR = 0; + // рассчет скорости передачи данных + TWBR = ((F_CPU/SCL_CLOCK)-16)/2; +} + +// передача условия СТАРТ на шину +unsigned char i2c_start(unsigned char address) +{ + uint8_t twst; + + // отправка условия СТАРТ + TWCR = (1<