398 lines
12 KiB
C++
398 lines
12 KiB
C++
#include "maidesite_desk.h"
|
|
|
|
|
|
namespace esphome
|
|
{
|
|
namespace maidesite_desk
|
|
{
|
|
static const char *const TAG = "maidesite_desk";
|
|
|
|
void MaidesiteDeskComponent::dump_config()
|
|
{
|
|
ESP_LOGCONFIG(TAG, "Maidesite Desk");
|
|
delay(10);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::setup()
|
|
{
|
|
ESP_LOGCONFIG(TAG, "Setting up Maidesite Desk ...");
|
|
delay(10);
|
|
this->check_uart_settings(9600);
|
|
this->request_physical_limits();
|
|
this->request_limits();
|
|
this->request_settings();
|
|
}
|
|
|
|
void MaidesiteDeskComponent::loop()
|
|
{
|
|
// This is a very simple method of receiving messages from the desk.
|
|
// It will fail on messages that contain the value 0x7E in their payload.
|
|
// But it is super simple and works for the messages we care about.
|
|
// Read message:
|
|
// format: 0xF2 0xF2 [command] [param_count] [[param] ...] [checksum] 0x7E
|
|
// checksum: sum of [command], [param_count] and all [param]s
|
|
|
|
uint8_t oneByte;
|
|
while (this->available())
|
|
{
|
|
this->read_byte(&oneByte);
|
|
|
|
// Message shall start with 0xF2, if not skip this byte
|
|
if (!this->response_receiving_)
|
|
{
|
|
if (oneByte != 0xF2)
|
|
continue;
|
|
this->response_receiving_ = true;
|
|
}
|
|
// Add current byte to message buffer
|
|
this->response_message_.push_back(oneByte);
|
|
|
|
// Discard message if 2. byte is not 0xF2
|
|
if (this->response_message_.size() == 2 && oneByte != 0xF2)
|
|
{
|
|
ESP_LOGW(TAG, "Invalid response message: 2. byte is 0x%02X but expexted is 0xF2", oneByte);
|
|
delay(10);
|
|
this->response_message_.clear();
|
|
this->response_receiving_ = false;
|
|
continue;
|
|
}
|
|
// Discard message if it is too long
|
|
if (this->response_message_.size() > 10)
|
|
{
|
|
ESP_LOGW(TAG, "Response message too long: expected not more than 10 bytes");
|
|
delay(10);
|
|
this->response_message_.clear();
|
|
this->response_receiving_ = false;
|
|
continue;
|
|
}
|
|
|
|
// Decode message if message is complete (last byte shall be 0x7E)
|
|
if (oneByte == 0x7E)
|
|
{
|
|
this->log_uart_hex("<<<", this->response_message_, ',');
|
|
this->decode_response(this->response_message_);
|
|
this->response_message_.clear();
|
|
this->response_receiving_ = false;
|
|
}
|
|
}
|
|
}
|
|
|
|
void MaidesiteDeskComponent::log_uart_hex(std::string prefix, std::vector<uint8_t> bytes, uint8_t separator)
|
|
{
|
|
if (this->log_uart_msg_ == false) return;
|
|
|
|
std::string logStr;
|
|
char buffer[5];
|
|
|
|
for (size_t i = 0; i < bytes.size(); i++)
|
|
{
|
|
if (i > 0) logStr += separator;
|
|
sprintf(buffer, "%02X", bytes[i]);
|
|
logStr += buffer;
|
|
}
|
|
for (size_t i = 0; i < logStr.length(); i += UART_LOG_CHUNK_SIZE)
|
|
{
|
|
ESP_LOGI(TAG, "%s %s", prefix.c_str(), logStr.substr(i, UART_LOG_CHUNK_SIZE).c_str());
|
|
delay(10);
|
|
}
|
|
}
|
|
|
|
void MaidesiteDeskComponent::decode_response(std::vector<uint8_t> message)
|
|
{
|
|
// ToDo: Add checksum check
|
|
|
|
switch (message[2])
|
|
{
|
|
case 0x01:
|
|
ESP_LOGI(TAG, "Set height to 0x%0X%0X", message[4], message[5]);
|
|
delay(10);
|
|
|
|
float new_height;
|
|
new_height = byte2float(message[4], message[5]);
|
|
if (new_height == this->current_height_)
|
|
return;
|
|
this->current_height_ = new_height;
|
|
if (this->height_abs_sensor_ != nullptr)
|
|
this->height_abs_sensor_->publish_state(this->current_height_);
|
|
if (this->height_abs_number_ != nullptr)
|
|
this->height_abs_number_->publish_state(this->current_height_);
|
|
|
|
if (this->height_pct_sensor_ != nullptr && limit_max_ != 0)
|
|
this->height_pct_sensor_->publish_state((this->current_height_ - this->limit_min_) / (this->limit_max_ - this->limit_min_) * 100);
|
|
if (this->height_pct_number_ != nullptr && limit_max_ != 0)
|
|
this->height_pct_number_->publish_state(roundf((this->current_height_ - this->limit_min_) / (this->limit_max_ - this->limit_min_) * 1000) / 10);
|
|
break;
|
|
|
|
case 0x20:
|
|
ESP_LOGI(TAG, "Set limits to 0x%0X max=%i min=%i", message[4], (message[5] & 1), (message[4] >> 4));
|
|
delay(10);
|
|
|
|
if ((message[4] & 1) == 0)
|
|
{ // low nibble 0 -> no max limit, use physical_max_
|
|
this->limit_max_ = this->physical_max_;
|
|
if (this->height_max_sensor_ != nullptr)
|
|
this->height_max_sensor_->publish_state(this->limit_max_);
|
|
if (height_abs_number_ != nullptr)
|
|
this->height_abs_number_->traits.set_max_value(this->limit_max_);
|
|
}
|
|
if ((message[4] >> 4) == 0)
|
|
{ // high nibble 0 -> no min limit, use physical_min_
|
|
this->limit_min_ = this->physical_min_;
|
|
if (this->height_min_sensor_ != nullptr)
|
|
this->height_min_sensor_->publish_state(limit_min_);
|
|
if (height_abs_number_ != nullptr)
|
|
this->height_abs_number_->traits.set_min_value(limit_min_);
|
|
}
|
|
break;
|
|
|
|
case 0x07:
|
|
ESP_LOGI(TAG, "Set physical limits to min=0x%02X%02X max=0x%02X%02X", message[4], message[5], message[6], message[7]);
|
|
delay(10);
|
|
|
|
this->physical_max_ = this->byte2float(message[4], message[5]);
|
|
this->physical_min_ = this->byte2float(message[6], message[7]);
|
|
break;
|
|
|
|
case 0x21:
|
|
ESP_LOGI(TAG, "Set max. height to 0x%02X%02X", message[4], message[5]);
|
|
delay(10);
|
|
|
|
this->limit_max_ = this->byte2float(message[4], message[5]);
|
|
if (this->height_max_sensor_ != nullptr)
|
|
this->height_max_sensor_->publish_state(limit_max_);
|
|
if (height_abs_number_ != nullptr)
|
|
this->height_abs_number_->traits.set_max_value(limit_max_);
|
|
break;
|
|
|
|
case 0x22:
|
|
ESP_LOGI(TAG, "Set min. height to 0x%02X%02X", message[4], message[5]);
|
|
delay(10);
|
|
|
|
this->limit_min_ = this->byte2float(message[4], message[5]);
|
|
if (this->height_min_sensor_ != nullptr)
|
|
this->height_min_sensor_->publish_state(limit_min_);
|
|
if (height_abs_number_ != nullptr)
|
|
this->height_abs_number_->traits.set_min_value(limit_min_);
|
|
break;
|
|
|
|
case 0x25:
|
|
ESP_LOGI(TAG, "Set position m1 to 0x%02X%02X", message[4], message[5]);
|
|
delay(10);
|
|
|
|
if (this->position_m1_sensor_ != nullptr)
|
|
this->position_m1_sensor_->publish_state(this->byte2float(message[4], message[5]));
|
|
break;
|
|
|
|
case 0x26:
|
|
ESP_LOGI(TAG, "Set position m2 to 0x%02X%02X", message[4], message[5]);
|
|
delay(10);
|
|
|
|
if (this->position_m2_sensor_ != nullptr)
|
|
this->position_m2_sensor_->publish_state(this->byte2float(message[4], message[5]));
|
|
break;
|
|
|
|
case 0x27:
|
|
ESP_LOGI(TAG, "Set position m3 to 0x%02X%02X", message[4], message[5]);
|
|
delay(10);
|
|
|
|
if (this->position_m3_sensor_ != nullptr)
|
|
this->position_m3_sensor_->publish_state(this->byte2float(message[4], message[5]));
|
|
break;
|
|
|
|
case 0x28:
|
|
ESP_LOGI(TAG, "Set position m4 to 0x%02X%02X", message[4], message[5]);
|
|
delay(10);
|
|
|
|
if (this->position_m4_sensor_ != nullptr)
|
|
this->position_m4_sensor_->publish_state(this->byte2float(message[4], message[5]));
|
|
break;
|
|
|
|
// case 0x0E:
|
|
// ESP_LOGI(TAG, "units 0x%02X", message[4]);
|
|
// if (units != nullptr)
|
|
// units->publish_state(byte2float(message[4], message[5]));
|
|
// break;
|
|
|
|
default:
|
|
ESP_LOGI(TAG, "Received unknown message");
|
|
delay(10);
|
|
}
|
|
}
|
|
|
|
float MaidesiteDeskComponent::byte2float(int high, int low)
|
|
{
|
|
return static_cast<float>((high << 8) + low) / 10;
|
|
}
|
|
|
|
// Write message:
|
|
// format: 0xF1 0xF1 [command] [param_count] [[param] ...] [checksum] 0x7E
|
|
// checksum: sum of [command], [param_count] and all [param]s
|
|
void MaidesiteDeskComponent::send_simple_command(unsigned char cmd)
|
|
{
|
|
this->request_message_.clear();
|
|
this->request_message_.insert(this->request_message_.end(), { 0xF1, 0xF1, cmd, 0x00, cmd, 0x7E });
|
|
this->write_array(this->request_message_);
|
|
this->log_uart_hex(">>>", this->request_message_, ',');
|
|
delay(100); // NOLINT
|
|
}
|
|
|
|
void MaidesiteDeskComponent::send_2byte_command(unsigned char cmd, unsigned char high_byte, unsigned char low_byte)
|
|
{
|
|
// ToDo: make one function of send_simple_command and send_2byte_command
|
|
|
|
unsigned char checksum = cmd + 2 + high_byte + low_byte;
|
|
this->request_message_.clear();
|
|
this->request_message_.insert(this->request_message_.end(), { 0xF1, 0xF1, cmd, 0x02, high_byte, low_byte, checksum, 0x7E });
|
|
this->write_array(this->request_message_);
|
|
this->log_uart_hex(">>>", this->request_message_, ',');
|
|
delay(100); // NOLINT
|
|
}
|
|
|
|
void MaidesiteDeskComponent::step_up()
|
|
{
|
|
this->send_simple_command(0x01);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::step_down()
|
|
{
|
|
this->send_simple_command(0x02);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::stop()
|
|
{
|
|
this->send_simple_command(0x2B);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::goto_mem_position(int pos)
|
|
{
|
|
switch (pos)
|
|
{
|
|
case 1:
|
|
this->send_simple_command(0x05);
|
|
break;
|
|
case 2:
|
|
this->send_simple_command(0x06);
|
|
break;
|
|
case 3:
|
|
this->send_simple_command(0x27);
|
|
break;
|
|
case 4:
|
|
this->send_simple_command(0x28);
|
|
break;
|
|
}
|
|
}
|
|
|
|
void MaidesiteDeskComponent::save_mem_position(int pos)
|
|
{
|
|
switch (pos)
|
|
{
|
|
case 1:
|
|
this->send_simple_command(0x03);
|
|
break;
|
|
case 2:
|
|
this->send_simple_command(0x04);
|
|
break;
|
|
case 3:
|
|
this->send_simple_command(0x25);
|
|
break;
|
|
case 4:
|
|
this->send_simple_command(0x26);
|
|
break;
|
|
}
|
|
}
|
|
|
|
void MaidesiteDeskComponent::request_physical_limits()
|
|
{
|
|
this->send_simple_command(0x0C);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::request_limits()
|
|
{
|
|
this->send_simple_command(0x20);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::request_settings()
|
|
{
|
|
this->send_simple_command(0x07);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::request_move_to()
|
|
{
|
|
this->send_simple_command(0x1B);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::goto_max_position()
|
|
{
|
|
this->goto_height(limit_max_);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::goto_min_position()
|
|
{
|
|
this->goto_height(limit_min_);
|
|
}
|
|
|
|
void MaidesiteDeskComponent::goto_height(float height)
|
|
{
|
|
unsigned char high_byte = ((int)height * 10) >> 8;
|
|
unsigned char low_byte = ((int)height * 10) & 0xFF;
|
|
|
|
this->send_2byte_command(0x80, high_byte, low_byte);
|
|
this->request_move_to();
|
|
}
|
|
|
|
#ifdef USE_BUTTON
|
|
void MaidesiteDeskComponent::button_press_action(button::Button* object)
|
|
{
|
|
if (object == step_up_button_)
|
|
this->step_up();
|
|
else if (object == step_down_button_)
|
|
this->step_down();
|
|
else if (object == stop_button_)
|
|
this->stop();
|
|
else if (object == goto_max_button_)
|
|
this->goto_max_position();
|
|
else if (object == goto_min_button_)
|
|
this->goto_min_position();
|
|
else if (object == goto_m1_button_)
|
|
this->goto_mem_position(1);
|
|
else if (object == goto_m2_button_)
|
|
this->goto_mem_position(2);
|
|
else if (object == goto_m3_button_)
|
|
this->goto_mem_position(3);
|
|
else if (object == goto_m4_button_)
|
|
this->goto_mem_position(4);
|
|
else if (object == save_m1_button_)
|
|
{
|
|
this->save_mem_position(1);
|
|
this->request_settings();
|
|
}
|
|
else if (object == save_m2_button_)
|
|
{
|
|
this->save_mem_position(2);
|
|
this->request_settings();
|
|
}
|
|
else if (object == save_m3_button_)
|
|
{
|
|
this->save_mem_position(3);
|
|
this->request_settings();
|
|
}
|
|
else if (object == save_m4_button_)
|
|
{
|
|
this->save_mem_position(4);
|
|
this->request_settings();
|
|
}
|
|
}
|
|
#endif
|
|
#ifdef USE_NUMBER
|
|
void MaidesiteDeskComponent::number_control(number::Number* object, float value)
|
|
{
|
|
if (object == height_abs_number_)
|
|
this->goto_height(value);
|
|
else if (object == height_pct_number_)
|
|
if (limit_max_ > 0 && limit_max_ > limit_min_)
|
|
this->goto_height((limit_max_ - limit_min_) * value / 100 + limit_min_);
|
|
}
|
|
#endif
|
|
} // namespace maidesite_desk
|
|
} // namespace esphome
|