Browse Source

Функции в одном стиле, чистка

pull/1/head
Sergey 5 years ago
parent
commit
c3299b9a61
  1. 6
      Marlin/src/core/serial.h
  2. 38
      Marlin/src/module/mks_wifi/mks_wifi.cpp
  3. 10
      Marlin/src/module/mks_wifi/mks_wifi.h

6
Marlin/src/core/serial.h

@ -70,7 +70,7 @@ extern uint8_t marlin_debug_flags;
#if ENABLED(MKS_WIFI)
#define SERIAL_ECHO(x) do{ \
if (!serial_port_index || serial_port_index == SERIAL_BOTH) SERIAL_OUT(print, x); \
if ( serial_port_index) mks_println(x); \
if ( serial_port_index) mks_wifi_print(x); \
}while(0)
#else
#define SERIAL_ECHO(x) SERIAL_OUT(print, x)
@ -81,7 +81,7 @@ extern uint8_t marlin_debug_flags;
#if ENABLED(MKS_WIFI)
#define SERIAL_ECHOLN(x) do{ \
if (!serial_port_index || serial_port_index == SERIAL_BOTH) SERIAL_OUT(println, x); \
if ( serial_port_index) mks_println_ln(x); \
if ( serial_port_index) mks_wifi_println(x); \
}while(0)
#else
#define SERIAL_ECHOLN(x) SERIAL_OUT(println, x)
@ -117,7 +117,7 @@ extern uint8_t marlin_debug_flags;
#if ENABLED(MKS_WIFI)
#define SERIAL_CHAR(V...) do{ \
if (!serial_port_index || serial_port_index == SERIAL_BOTH) _CHAR_N(NUM_ARGS(V),V); \
if ( serial_port_index) mks_wifi_out(NUM_ARGS(V),V); \
if ( serial_port_index) mks_wifi_print_var(NUM_ARGS(V),V); \
}while(0)
#else
#define SERIAL_CHAR(V...) _CHAR_N(NUM_ARGS(V),V)

38
Marlin/src/module/mks_wifi/mks_wifi.cpp

@ -51,7 +51,6 @@ void mks_wifi_set_param(void){
buf_to_wifi[data_offset + apLen + 2] = keyLen;
strncpy(&buf_to_wifi[data_offset + apLen + 3], (const char *)wifi_key, keyLen);
buf_to_wifi[data_offset + apLen + keyLen + 3] = ESP_PROTOC_TAIL;
DEBUG("Tail index %d",(data_offset + apLen + keyLen + 3));
index_to_wifi = apLen + keyLen + 3;
buf_to_wifi[0] = ESP_PROTOC_HEAD;
@ -79,12 +78,9 @@ ESP и отправляет
void mks_wifi_out_add(uint8_t *data, uint32_t size){
uint32_t datalen;
uint32_t packet_size;
uint8_t *data_ptr;
data_ptr=data; //чтобы не трогать адрес
while (size--){
if(*data_ptr == 0x0a){
if(*data == 0x0a){
//Переводы строки внутри формирования пакета
//Перевод строки => сформировать пакет, отправить, сбросить индекс
datalen=strnlen((char *)mks_out_buffer,ESP_PACKET_DATA_MAX_SIZE);
@ -98,7 +94,7 @@ void mks_wifi_out_add(uint8_t *data, uint32_t size){
line_index=0;
}else{
//писать в буфер
mks_out_buffer[line_index++]=*data_ptr++;
mks_out_buffer[line_index++]=*data++;
}
if(line_index >= ESP_SERIAL_OUT_MAX_SIZE){
@ -175,7 +171,6 @@ void mks_wifi_parse_packet(ESP_PROTOC_FRAME *packet){
}
break;
case ESP_TYPE_GCODE:
//DEBUG("[Gcode] %s",packet->data);
break;
case ESP_TYPE_FILE_FIRST:
DEBUG("[FILE_FIRST]");
@ -195,7 +190,7 @@ void mks_wifi_parse_packet(ESP_PROTOC_FRAME *packet){
}
void mks_wifi_out(uint8_t count, ...){
void mks_wifi_print_var(uint8_t count, ...){
va_list args;
uint8_t data;
@ -209,20 +204,26 @@ void mks_wifi_out(uint8_t count, ...){
}
void mks_println(const char *s){
DEBUG("char* %s",s);
void mks_wifi_print(const char *s){
mks_wifi_out_add((uint8_t *)s, strnlen((char *)s,ESP_PACKET_DATA_MAX_SIZE));
}
void mks_println_ln(const char *s){
void mks_wifi_print(int i){
char str[14];
sprintf(str,"%d",i);
mks_wifi_out_add((uint8_t *)str, strnlen((char *)str,ESP_PACKET_DATA_MAX_SIZE));
}
void mks_wifi_println(const char *s){
mks_wifi_out_add((uint8_t *)s, strnlen((char *)s,ESP_PACKET_DATA_MAX_SIZE));
}
void mks_println_ln(float f){
uint32_t data=(uint32_t)f;
void mks_wifi_println(float f){
char str[30];
DEBUG("Float");
sprintf(str,"%ld\n",data);
sprintf(str,"%ld\n",(uint32_t)f);
mks_wifi_out_add((uint8_t *)str, strnlen((char *)str,ESP_PACKET_DATA_MAX_SIZE));
}
@ -236,7 +237,7 @@ uint16_t mks_wifi_build_packet(uint8_t *packet, uint8_t type, uint8_t *data, uin
*((uint16_t *)&packet[2]) = count + 2; //Два байта на 0x0d 0x0a
for(uint32_t i=0; i < count; i++){
packet[i+4]=data[i];
packet[i+4]=data[i]; //4 байта заголовка отступить
}
packet_size = count + 4;
@ -255,8 +256,3 @@ void mks_wifi_send(uint8_t *packet, uint16_t size){
}
}
void mks_println(int i){
char str[30];
sprintf(str,"%d",i);
mks_wifi_out_add((uint8_t *)str, strnlen((char *)str,ESP_PACKET_DATA_MAX_SIZE));
}

10
Marlin/src/module/mks_wifi/mks_wifi.h

@ -47,12 +47,12 @@ void mks_wifi_out_add(uint8_t *data, uint32_t size);
uint16_t mks_wifi_build_packet(uint8_t *packet, uint8_t type, uint8_t *data, uint16_t count);
void mks_wifi_send(uint8_t *packet, uint16_t size);
void mks_wifi_out(uint8_t count, ...);
void mks_wifi_print_var(uint8_t count, ...);
void mks_println(const char *s);
void mks_println(int i);
void mks_wifi_print(const char *s);
void mks_wifi_print(int i);
void mks_println_ln(const char *s);
void mks_println_ln(float);
void mks_wifi_println(const char *s);
void mks_wifi_println(float);
#endif
Loading…
Cancel
Save