Skip to content

H
hddtempserial
Commit 5812907a authored by Oleg Nikulin's avatar Oleg Nikulin
Browse files
Options

Переделана логика обмена (пк=мастер, коды команд); Rewrite скрипта и прошивки

parent fd983901
Show whitespace changes
Inline Side-by-side
Showing with 420 additions and 222 deletions
communication.py 0 → 100644
View file @ 5812907a
import serial
import time
def open_serial(port, baudrate):
try: #пытаемся открыть serial порт
serial_port = serial.Serial(
port = port,
baudrate = baudrate,
bytesize = 8,
parity = serial.PARITY_NONE,
stopbits = serial.STOPBITS_ONE
)
except OSError:
return None
print('Delay before starting serial...')
time.sleep(2)
serial_port.reset_input_buffer()
serial_port.reset_output_buffer()
return serial_port
def serial_exchange(serial_port, transmit_bytes, required_response_length, timeout = 1):
if serial_port is None:
raise OSError
serial_port.reset_input_buffer()
serial_port.reset_output_buffer()
serial_port.write(bytearray(transmit_bytes))
if required_response_length == 0:
return bytes([])
#ждем ответ
steps = 10
for i in range(steps):
if serial_port.in_waiting >= required_response_length: break
time.sleep(timeout / steps)
if serial_port.in_waiting < required_response_length:
return None
response = serial_port.read(required_response_length)
return response
config.json 0 → 100644
View file @ 5812907a
{
"device": "/dev/ttyUSB0",
"baudrate": 19200,
"pollIntervalSec": 2,
"arduinoTimeoutSec": 0.25,
"controlGroups":
[
{
"targetTemperature": 35,
"copyFromGroupIndex": 255
},
{
"targetTemperature": 40,
"copyFromGroupIndex": 255
},
{
"targetTemperature": 45,
"copyFromGroupIndex": 255
}
]
}
\ No newline at end of file
general.py 0 → 100644
View file @ 5812907a
import subprocess
import time
import serial
import argparse
from argparse import RawTextHelpFormatter
import datetime
import threading
from threading import Event
import json
class pc_command_codes:
initialize = 1
poll = 2
class arduino_response_codes:
initialize_ok = 1
poll_noinit = 2
poll_ok = 3
fail = 255
POLL_SLEEP_TIME = 0.1 #Задержка между проверками наличия запроса от ардуины (cек)
RECONNECT_SLEEP_TIME = 1 #Задержка между попытками открыть serial порт при потере связи (cек)
TIMEOUT_TIME = 3 #Считается что ардуина перестала отвечать, если от нее не было запросов в течение этого времени (cек)
config = None
def load_json(filename):
try:
jsonFile = open(filename, mode='r', encoding='utf-8')
except:
print(f'Failed to open {filename}')
return None
try:
config = json.load(jsonFile)
except:
print(f'Failed to read json from {filename}')
return None
jsonFile.close()
return config
def cmdline_args_parse():
parser = argparse.ArgumentParser(
description = 'This script sends PC disk temperature via a serial port',
formatter_class=RawTextHelpFormatter
)
parser.add_argument('-m', '--manual',
required = False,
action='store_true',
help = 'send temperature from user input instead of hddtemp',
)
parser.add_argument('device',
type = str,
nargs = '?',
help = 'serial device to commuicate with. Example: /dev/ttyUSB0',
metavar = 'SERIAL'
)
parser.add_argument('speed',
type = int,
nargs = '?',
help = 'serial port baud rate',
metavar = 'SPEED'
)
args = parser.parse_args()
return args
\ No newline at end of file
hddtempserial.py
View file @ 5812907a
#epmi pip #epmi pip
#pip install pyserial #pip install pyserial
import subprocess from general import *
import time from communication import *
import serial import termios
import argparse
from argparse import RawTextHelpFormatter
import datetime
import threading
POLL_SLEEP_TIME = 0.1 #Задержка между проверками наличия запроса от ардуины (cек)
RECONNECT_SLEEP_TIME = 1 #Задержка между попытками открыть serial порт при потере связи (cек)
TIMEOUT_TIME = 3 #Считается что ардуина перестала отвечать, если от нее не было запросов в течение этого времени (cек)
PORT:str = None
SPEED:int = None
temp = '50'
connected = False
input_thread_running = False input_thread_running = False
initialized = False
temperatures = [30, 45, 50]
def temp_input(): def temp_input(stop_event):
global temp global temperatures
while True: while True:
temp_input = input('\033[60C' + 'Enter up to 3 temperature values (comma-separated): ') temps = [0, 0, 0]
temp_input = input('\033[75G' + 'Enter up to 3 temperature values (CSV): ')
if stop_event.is_set():
input_thread_running = False
return
error = False error = False
comma_pos = 0 comma_pos = 0
...@@ -46,9 +42,8 @@ def temp_input(): ...@@ -46,9 +42,8 @@ def temp_input():
temp_substring = temp_input[find_start_index:comma_pos] temp_substring = temp_input[find_start_index:comma_pos]
try: #проверка, введено ли число try: #проверка, введено ли число
int(temp_substring) temps[i] = int(temp_substring)
except ValueError: except ValueError:
print('Temperature value must be a number')
error = True error = True
break break
...@@ -57,86 +52,133 @@ def temp_input(): ...@@ -57,86 +52,133 @@ def temp_input():
find_start_index = comma_pos + 1 find_start_index = comma_pos + 1
if not error: #если всё хорошо, введенную строку можно отправлять if not error: #если всё хорошо, введенные значения можно отправлять
temp = temp_input temperatures = temps
parser = argparse.ArgumentParser(
description = 'This script sends PC disk temperature via a serial port',
formatter_class=RawTextHelpFormatter
)
parser.add_argument('-m', '--manual',
required = False,
action='store_true',
help = 'send temperature from user input instead of hddtemp',
)
parser.add_argument('device',
type = str,
nargs = '?',
help = 'serial device to commuicate with. Example: /dev/ttyUSB0',
metavar = 'SERIAL'
)
parser.add_argument('speed',
type = int,
nargs = '?',
help = 'serial port baud rate',
metavar = 'SPEED'
)
args = parser.parse_args()
def initialize(serial_port):
global initialized
initialized = False
#проверка наличия аргументов transmit_bytes = [
if args.device == None: pc_command_codes.initialize,
print('Serial device was not specified') config['pollIntervalSec'],
exit() config['controlGroups'][0]['targetTemperature'],
if args.speed == None: config['controlGroups'][1]['targetTemperature'],
print('Serial port baud rate was not specified') config['controlGroups'][2]['targetTemperature'],
exit() config['controlGroups'][0]['copyFromGroupIndex'],
if args.manual: config['controlGroups'][1]['copyFromGroupIndex'],
input_thread = threading.Thread(target = temp_input) config['controlGroups'][2]['copyFromGroupIndex']
temp = '50,51,52' ]
response_length = 1
response = serial_exchange(serial_port, transmit_bytes, response_length, config['arduinoTimeoutSec'])
if response is None:
print('Initialize failed')
else:
if response[0] == arduino_response_codes.initialize_ok:
initialized = True
print('Initialize ok')
else:
print('Initialize not ok')
def poll(serial_port):
global initialized, temperatures
#температуры 16-битные со знаком (ну на всякий случай)
transmit_bytes = [
pc_command_codes.poll,
(temperatures[0] >> 8) & 0xff,
temperatures[0] & 0xff,
(temperatures[1] >> 8) & 0xff,
temperatures[1] & 0xff,
(temperatures[2] >> 8) & 0xff,
temperatures[2] & 0xff,
]
response_length = 16
response = serial_exchange(serial_port, transmit_bytes, response_length, config['arduinoTimeoutSec'])
if response is None:
initialized = False
print('Poll failed')
else:
if response[0] == arduino_response_codes.poll_noinit:
initialized = False
print('Arduino is not initialized. Probably it was reset')
elif response[0] == arduino_response_codes.poll_ok:
rpms = [0] * 6
pwms = [0] * 3
#rpm 16-битные без знака
for i in range(6):
rpms[i] = int.from_bytes(response[i*2+1 : i*2+3], byteorder='big', signed=False)
for i in range(3):
pwms[i] = response[i+13]
#print(f'RPM: {rpms} PWM: {pwms}')
#сохранение положения курсора, перевод на 74й символ, очистка всего перед курсором, курсор в начало строки, вывод оборотов, загрузка положения строки
print('\0337' +'\033[74G' + '\033[1K' + '\033[0G' + f'RPM: {rpms} PWM: {pwms}' + '\0338', end = '', flush=True)
return True
else:
initialized = False
print('Poll not ok')
PORT = args.device return False
SPEED = args.speed
try: #пытаемся открыть serial порт
serial_port = serial.Serial( if __name__ == "__main__":
port = PORT, config = load_json('config.json')
baudrate = SPEED, if config is None:
parity = serial.PARITY_NONE,
stopbits=serial.STOPBITS_ONE,
)
except OSError:
print('An error has occured while opening the serial port')
exit() exit()
print('Connecting to the serial device...') args = cmdline_args_parse()
serial_port.reset_input_buffer()
while True:
try:
if serial_port.in_waiting > 0:
if not connected:
if serial_port.readline().decode()[:-2] == 'start_transmission':
last_serial_input_time = datetime.datetime.now().timestamp()
serial_port.write('starting_transmission\n'.encode())
print('Connected. Starting transmission')
connected = True
if args.manual and not input_thread_running:
input_thread.start()
input_thread_running = True
incoming_line = serial_port.readline().decode()[:-2] port = None
baudrate = None
if 'req_temperature' in incoming_line: if config['device'] is not None:
last_serial_input_time = datetime.datetime.now().timestamp() port = config['device']
if config['baudrate'] is not None:
baudrate = config['baudrate']
if args.device is not None:
port = args.device
if args.speed is not None:
baudrate = args.speed
if args.manual: if args.manual:
serial_port.write(('temperature_' + temp + '\n').encode()) #отправка значения input_stop_event = Event()
input_thread = threading.Thread(target = temp_input, args=(input_stop_event,))
temp = '50,51,52'
if port is None:
print('Serial device is not specified (neither in config nor in command line)')
exit()
if baudrate is None:
print('Baudrate is not specified (neither in config nor in command line)')
exit()
serial_port = open_serial(port, baudrate)
if serial_port is None:
print('Failed to open serial port')
exit()
try:
while True:
regularPollInterval = False
try:
if not initialized:
initialize(serial_port)
else: else:
if not args.manual:
output = str(subprocess.Popen(['netcat', 'localhost', '7634'], stdout = subprocess.PIPE, stderr = subprocess.STDOUT).communicate()[0]) #получаем output от hddtemp output = str(subprocess.Popen(['netcat', 'localhost', '7634'], stdout = subprocess.PIPE, stderr = subprocess.STDOUT).communicate()[0]) #получаем output от hddtemp
#b'|/dev/sda2|ST340014A|41|C|' #b'|/dev/sda2|ST340014A|41|C|'
if output == "b''": if output == "b''":
...@@ -148,37 +190,30 @@ while True: ...@@ -148,37 +190,30 @@ while True:
temp_pos_start = output.rfind('|', 0, temp_pos_end) + 1 temp_pos_start = output.rfind('|', 0, temp_pos_end) + 1
temp = output[temp_pos_start:temp_pos_end] temp = output[temp_pos_start:temp_pos_end]
try: try:
int(temp) temperatures[0] = int(temp)
#print(temp + ' C')
serial_port.write(('temperature_' + temp + '\n').encode()) #отправка значения
except ValueError: except ValueError:
print('Error: Failed to get a temperature value from hddtemp output') print('Error: Failed to get a temperature value from hddtemp output')
if 'send_rpm' in incoming_line: if (poll(serial_port)):
send_rpm_pos = incoming_line.find('send_rpm_') if args.manual and not input_thread_running:
rpm_string = incoming_line[send_rpm_pos + 9:] input_stop_event.clear()
rpm_string = rpm_string.replace('_', ' ') input_thread.start()
rpm_string = 'Fan RPMs: ' + rpm_string input_thread_running = True
#сохранение положения курсора, перервод в начало строки, перевод на 59 символов вправо, очистка всего перед курсором, курсор в начало строки, вывод оборотов, загрузка положения строки regularPollInterval = True
print('\0337' + '\033[255D' +'\033[59C' + '\033[1K' + '\033[255D' + rpm_string + '\0338', end = '', flush=True)
except (OSError, termios.error):
except OSError: input_stop_event.set()
if connected: print()
print('\nSerial divice was disconnected. Trying to reconnect...') print('Serial port error. Trying to open serial port again...')
connected = False serial_port = open_serial(port, baudrate)
if serial_port is not None:
try: #пытаемся снова открыть serial порт print('Success')
serial_port = serial.Serial(
port = '/dev/' + PORT, #обычнаый интервал используется при обычном обмене когда всё ок
baudrate = SPEED if (regularPollInterval):
) time.sleep(config['pollIntervalSec'])
connected = True else:
except OSError: print('...') time.sleep(0.5)
time.sleep(RECONNECT_SLEEP_TIME) except KeyboardInterrupt:
exit()
if connected and datetime.datetime.now().timestamp() - last_serial_input_time > TIMEOUT_TIME:
print('\nSerial device is not responding')
connected = False
time.sleep(POLL_SLEEP_TIME)
\ No newline at end of file
hddtempserial/hddtempserial.ino
View file @ 5812907a
#include <Wire.h> //#include <Wire.h>
#define FAN_COUNT 6 //Количество вентиляторов #define FAN_COUNT 6 //Количество вентиляторов
#define CONTROL_COUNT 3 //Количество групп управления #define CONTROL_COUNT 3 //Количество групп управления
#define BAUDRATE 19200 //Скорость serial порта #define BAUDRATE 19200 //Скорость serial порта
#define CHECK_TEMP_DELAY 200 //Интервал получения температуры от пк (мс)
#define GET_TEMP_TIMEOUT 1000 //Если в течение этого времени температура не была прислана, считается что пк не отвечает (мс)
#define RPM_CHECK_INTERVAL 200 //Интервал подсчета rpm и обнуления tachRevs (мс) #define RPM_CHECK_INTERVAL 200 //Интервал подсчета rpm и обнуления tachRevs (мс)
#define RPM_VALUES_COUNT 5 //Количество значений RPM, которые записываются и усредняются (скользящее среднее) #define RPM_VALUES_COUNT 5 //Количество значений RPM, которые записываются и усредняются (скользящее среднее)
#define MIN_PWM_DUTY_CYCLE 2 //Минимальная скважность ШИМ #define MIN_PWM_DUTY_CYCLE 2 //Минимальная скважность ШИМ
#define MAX_PWM_DUTY_CYCLE 254 //Максимальная скважность ШИМ #define MAX_PWM_DUTY_CYCLE 254 //Максимальная скважность ШИМ
#define DEFAULT_PWM_DUTY_CYCLE 254 //Скважность ШИМ по умолчанию (до подулючения к пк) #define DEFAULT_PWM_DUTY_CYCLE MAX_PWM_DUTY_CYCLE //Скважность ШИМ по умолчанию (до подключения к пк)
#define BEEP_INTERVAL 1000 //Интервал пищания во время потери связи или перегрева (мс) #define BEEP_INTERVAL 1000 //Интервал пищания во время потери связи или перегрева (мс)
#define BEEP_STRENGTH 100 //Уровень ШИМ для пищалки. (При 255 не работает, нужно чтобы был именно ШИМ) #define BEEP_STRENGTH 100 //Уровень ШИМ для пищалки. (При 255 не работает, нужно чтобы был именно ШИМ)
...@@ -29,6 +27,8 @@ struct control {//Данные о группе управления ...@@ -29,6 +27,8 @@ struct control {//Данные о группе управления
uint8_t pin; //Номер пина uint8_t pin; //Номер пина
volatile uint8_t mode; //Текущий режим работы. 0 - всегда выкл, 1 - шим, 2 - всегда вкл volatile uint8_t mode; //Текущий режим работы. 0 - всегда выкл, 1 - шим, 2 - всегда вкл
uint8_t &dutyCycle; //Скважность ШИМ uint8_t &dutyCycle; //Скважность ШИМ
int16_t temperature; //Текущая температура
int16_t target_temperature; //Температура, к которой нужно стремиться
int8_t copy_from; //Копировать скважность с другой группы управления. -1 = не копировать, 0 = с группы A, 1 = с группы B, 2 = с группы C int8_t copy_from; //Копировать скважность с другой группы управления. -1 = не копировать, 0 = с группы A, 1 = с группы B, 2 = с группы C
}; };
...@@ -37,18 +37,24 @@ control controls[CONTROL_COUNT] = { ...@@ -37,18 +37,24 @@ control controls[CONTROL_COUNT] = {
3, 3,
1, 1,
*control_a_addr, *control_a_addr,
0,
0,
-1 -1
}, },
{ {
5, 5,
1, 1,
*control_b_addr, *control_b_addr,
0,
0,
0 0
}, },
{ {
6, 6,
1, 1,
*control_c_addr, *control_c_addr,
0,
0,
0 0
} }
}; };
...@@ -120,10 +126,8 @@ fan &fan_5 = fans[4]; ...@@ -120,10 +126,8 @@ fan &fan_5 = fans[4];
fan &fan_6 = fans[5]; fan &fan_6 = fans[5];
int temps[3] = {}; //Температуры, полученные от пк
uint32_t last_beep_time = 0; uint32_t last_beep_time = 0;
uint32_t last_check_time = 0; uint32_t last_poll_time = 0;
uint32_t lastRpmCheck = 0; uint32_t lastRpmCheck = 0;
float p[3] = {}; float p[3] = {};
...@@ -136,120 +140,124 @@ float k_d = 0; ...@@ -136,120 +140,124 @@ float k_d = 0;
float i_max = 210; float i_max = 210;
int target_temps[3] = {27, 0, 0}; //Температуры, к которым нужно стремиться enum pc_command_codes {
initialize = 1,
poll = 2
};
void wait_for_connection(bool beep) { //функция, которая мигает светодиодом и пищит (если beep == true) до тех пор, пока не будет установлено соединение с ПК enum arduino_response_codes {
Serial.println("start_transmission"); initialize_ok = 1,
digitalWrite(LED_PIN, 1); poll_noinit = 2,
unsigned long last_blink_time = millis(); poll_ok = 3,
while (Serial.available() == 0) {//ждем ответа fail = 255
if (millis() >= last_blink_time + BLINK_INTERVAL * 2) { };
digitalWrite(LED_PIN, 1);
last_blink_time = millis();
}
else if (millis() >= last_blink_time + BLINK_INTERVAL) {
digitalWrite(LED_PIN, 0);
}
if (beep) {
if (millis() >= last_beep_time + BEEP_INTERVAL * 2) {
analogWrite(SOUND_PIN, BEEP_STRENGTH);
last_beep_time = millis();
}
else if (millis() >= last_beep_time + BEEP_INTERVAL) {
analogWrite(SOUND_PIN, 0);
}
}
}
digitalWrite(LED_PIN, 0); //гасим светодиод
analogWrite(SOUND_PIN, 0); //и выключаем пищалку
while (Serial.available()) {// очистка буфера
Serial.readString();
}
}
int16_t pc_poll_interval_sec = -1;
bool pc_respond = true;
bool initialized = false;
void tempFromPc()// получаем температуру от пк
{ uint16_t get_avg_rpm(fan* fan_ptr) {
String rpm_string = "send_rpm_";
for (int fan = 0; fan < FAN_COUNT; fan++) {
uint32_t avg_rpm = 0; uint32_t avg_rpm = 0;
for (int val = 0; val < RPM_VALUES_COUNT; val++) { for (int val = 0; val < RPM_VALUES_COUNT; val++) {
avg_rpm += fans[fan].rpm[val]; avg_rpm += fan_ptr->rpm[val];
} }
avg_rpm /= RPM_VALUES_COUNT; avg_rpm /= RPM_VALUES_COUNT;
return avg_rpm;
}
rpm_string += String(avg_rpm);
if (fan < 5) {
rpm_string += "_";
}
}
Serial.println("req_temperature_" + rpm_string + "_debug_" + String(OCR1A) + "_" + String(OCR2A) + "_" + String(OCR2B)); //запрос к пк void process_command() {
unsigned long query_time = millis(); uint8_t cmd_code = 0;
while (Serial.available() == 0) { //ждем пока ответит uint8_t cmd_buffer[32] = {};
if (millis() >= query_time + GET_TEMP_TIMEOUT) { //если слишком долго не отвечает uint8_t cmd_length = 0;
//Венитялторы на максимум
for (int i = 0; i < CONTROL_COUNT; i++) { uint8_t response_buffer[32] = {};
controls[i].dutyCycle = DEFAULT_PWM_DUTY_CYCLE; //установка скважности по умолчанию response_buffer[0] = arduino_response_codes::fail;
} uint8_t response_length = 1;
wait_for_connection(true);//снова ждем подключения
//читаем первый байт (код команды)
if (Serial.readBytes(&cmd_code, 1) == 0)
return;
//по коду команды понимаем сколько еще байтов надо принять
switch(cmd_code) {
case pc_command_codes::initialize:
cmd_length = 7;
break;
case pc_command_codes::poll:
cmd_length = 6;
break;
default:
break; break;
} }
}
String response = Serial.readStringUntil('\n'); //выделяем строку до \n
int temperature_index = response.indexOf("temperature_"); //читаем команду
if (cmd_length > 0) {
uint8_t bytes_read = Serial.readBytes(cmd_buffer, cmd_length);
if (temperature_index != -1) { //если в строке есть temperature_ //выполняем команду
String temperatures = response.substring(temperature_index + 12); //отбрасываем temperature_ if (bytes_read == cmd_length) {
switch(cmd_code) {
case pc_command_codes::initialize:
pc_poll_interval_sec = cmd_buffer[0];
int comma_pos = 0; control_a.target_temperature = cmd_buffer[1];
int find_start_index = 0; control_b.target_temperature = cmd_buffer[2];
control_c.target_temperature = cmd_buffer[3];
for (int i = 0; i < 3; i++) { //парсим строку с температурами control_a.copy_from = cmd_buffer[4];
String temp_substring = ""; control_b.copy_from = cmd_buffer[5];
comma_pos = temperatures.indexOf(",", find_start_index); control_c.copy_from = cmd_buffer[6];
if (comma_pos == -1) { //если запятой не найдено, то до конца строки initialized = true;
temp_substring = temperatures.substring(find_start_index);
}
else {
temp_substring = temperatures.substring(find_start_index, comma_pos);
}
//проверка, является ли temp_substring числом: response_buffer[0] = arduino_response_codes::initialize_ok;
if (temp_substring.length() == 0) { response_length = 1;
break;
}
bool isInt = 1;
for (int i = 0; i < temp_substring.length(); i++) {
if (isDigit(temp_substring.charAt(i)) == false && (temp_substring.charAt(i) != '-' || (temp_substring.charAt(i) == '-' && i > 0))) {
isInt = 0;
break;
}
}
if (!isInt) {
break; break;
}
temps[i] = temp_substring.toInt(); case pc_command_codes::poll:
control_a.temperature = cmd_buffer[0] << 8 | cmd_buffer[1];
control_b.temperature = cmd_buffer[2] << 8 | cmd_buffer[3];
control_c.temperature = cmd_buffer[4] << 8 | cmd_buffer[5];
if (initialized)
response_buffer[0] = arduino_response_codes::poll_ok;
else
response_buffer[0] = arduino_response_codes::poll_noinit;
for (int i = 0; i < FAN_COUNT; i++){
uint16_t rpm = get_avg_rpm(&fans[i]);
response_buffer[i*2+1] = rpm >> 8;
response_buffer[i*2+2] = rpm & 0xff;
}
response_buffer[13] = OCR1A;
response_buffer[14] = OCR2A;
response_buffer[15] = OCR2B;
response_length = 16;
break;
if (comma_pos == -1) { //если запятых больше нет, выходим из цикла default:
break; break;
} }
find_start_index = comma_pos + 1;
} }
last_poll_time = millis();
pc_respond = true;
} }
}
while (Serial.available()) // очистка буфера
Serial.read();
//ответ
Serial.write(response_buffer, response_length);
}
...@@ -265,18 +273,22 @@ void rpm_control() { ...@@ -265,18 +273,22 @@ void rpm_control() {
for (int group = 0; group < 3; group++) {//управление скоростью 3-х групп вентиляторов for (int group = 0; group < 3; group++) {//управление скоростью 3-х групп вентиляторов
if (controls[group].copy_from == -1) { if (controls[group].copy_from < 0 || controls[group].copy_from > 2) {
uint8_t duty_cycle = 0; uint8_t duty_cycle = 0;
float pwmDutyCycle = MAX_PWM_DUTY_CYCLE;
d[group] = (temps[group] - target_temps[group] - p[group]) / float(millis() - lastRpmCheck); if (pc_respond){
p[group] = temps[group] - target_temps[group]; d[group] = (controls[group].temperature - controls[group].target_temperature - p[group]) / float(millis() - lastRpmCheck);
p[group] = controls[group].temperature - controls[group].target_temperature;
i[group] = i[group] + p[group] * (millis() - lastRpmCheck); i[group] = i[group] + p[group] * (millis() - lastRpmCheck);
if (fabs(i[group] * k_i) >= i_max) { if (fabs(i[group] * k_i) >= i_max) {
i[group] = i_max / k_i; i[group] = i_max / k_i;
} }
float pwmDutyCycle = round(p[group] * k_p + i[group] * k_i + d[group] * k_d); pwmDutyCycle = round(p[group] * k_p + i[group] * k_i + d[group] * k_d);
}
if (pwmDutyCycle < 0) { if (pwmDutyCycle < 0) {
duty_cycle = 0; duty_cycle = 0;
...@@ -419,8 +431,6 @@ void setup() { ...@@ -419,8 +431,6 @@ void setup() {
} }
Serial.begin(BAUDRATE); Serial.begin(BAUDRATE);
wait_for_connection(false); //Ждем установленя связи с ПК
} }
...@@ -428,11 +438,23 @@ void setup() { ...@@ -428,11 +438,23 @@ void setup() {
void loop() { void loop() {
if (uint32_t(millis() - last_check_time) >= CHECK_TEMP_DELAY) { if (Serial.available() > 0)
last_check_time = millis(); {
tempFromPc();//получаем температуру от пк process_command();
}
if (initialized)
{
if (uint32_t(millis() - lastRpmCheck) >= RPM_CHECK_INTERVAL) {
rpm_control();
}
}
if (pc_poll_interval_sec != -1 && uint32_t(millis() - last_poll_time) >= pc_poll_interval_sec * 2 * 1000) {
pc_respond = false;
}
if (temps[0] >= OVERHEAT_TEMP || temps[1] >= OVERHEAT_TEMP || temps[2] >= OVERHEAT_TEMP ) { //Если перегрев, включается пищалка if (control_a.temperature >= OVERHEAT_TEMP || control_b.temperature >= OVERHEAT_TEMP || control_c.temperature >= OVERHEAT_TEMP ) { //Если перегрев, включается пищалка
if (millis() >= last_beep_time + BEEP_INTERVAL * 2) { if (millis() >= last_beep_time + BEEP_INTERVAL * 2) {
analogWrite(SOUND_PIN, BEEP_STRENGTH); analogWrite(SOUND_PIN, BEEP_STRENGTH);
last_beep_time = millis(); last_beep_time = millis();
...@@ -442,12 +464,8 @@ void loop() { ...@@ -442,12 +464,8 @@ void loop() {
} }
} }
else { else {
analogWrite(SOUND_PIN, 0); //Чтобы постоянно не пищал, если температура станет < 80 в то время, как пищалка включена analogWrite(SOUND_PIN, 0); //Чтобы постоянно не пищал, если температура станет нормальной в то время, как пищалка включена
} }
}
if (uint32_t(millis() - lastRpmCheck) >= RPM_CHECK_INTERVAL) {
rpm_control();
}
} }
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment