Fix PID autotune
This commit is contained in:
@@ -354,15 +354,33 @@ uint16_t mks_wifi_build_packet(uint8_t *packet, ESP_PROTOC_FRAME *esp_frame){
|
|||||||
|
|
||||||
|
|
||||||
void mks_wifi_send(uint8_t *packet, uint16_t size){
|
void mks_wifi_send(uint8_t *packet, uint16_t size){
|
||||||
|
static uint32_t error_flag=0;
|
||||||
|
uint32_t timeout;
|
||||||
|
|
||||||
|
/*
|
||||||
|
Если уже был выход по превышению ожидания и место
|
||||||
|
очереди так и не освободилось, сразу выход.
|
||||||
|
*/
|
||||||
|
|
||||||
|
if(error_flag == 1){
|
||||||
|
if(MYSERIAL2.availableForWrite()==0){
|
||||||
|
return;
|
||||||
|
}else{
|
||||||
|
error_flag = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
for( uint32_t i=0; i < (uint32_t)(size+1); i++){
|
for( uint32_t i=0; i < (uint32_t)(size+1); i++){
|
||||||
|
timeout = 0xaffffff;
|
||||||
while(MYSERIAL2.availableForWrite()==0){
|
while(MYSERIAL2.availableForWrite()==0){
|
||||||
safe_delay(10);
|
--timeout;
|
||||||
|
if(!timeout){
|
||||||
|
error_flag=1;
|
||||||
|
return;
|
||||||
|
};
|
||||||
}
|
}
|
||||||
MYSERIAL2.write(packet[i]);
|
MYSERIAL2.write(packet[i]);
|
||||||
}
|
}
|
||||||
|
|
||||||
safe_delay(5);
|
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
void mks_wifi_out_add(uint8_t *data, uint32_t size){
|
void mks_wifi_out_add(uint8_t *data, uint32_t size){
|
||||||
|
|||||||
Reference in New Issue
Block a user