mirror of
https://github.com/esphome/esphome.git
synced 2024-12-02 11:44:13 +01:00
ac0d921413
* Socket refactor and SSL * esp-idf temp * Fixes * Echo component and noise * Add noise API transport support * Updates * ESP-IDF * Complete * Fixes * Fixes * Versions update * New i2c APIs * Complete i2c refactor * SPI migration * Revert ESP Preferences migration, too complex for now * OTA support * Remove echo again * Remove ssl again * GPIOFlags updates * Rename esphal and ICACHE_RAM_ATTR * Make ESP32 arduino compilable again * Fix GPIO flags * Complete pin registry refactor and fixes * Fixes to make test1 compile * Remove sdkconfig file * Ignore sdkconfig file * Fixes in reviewing * Make test2 compile * Make test4 compile * Make test5 compile * Run clang-format * Fix lint errors * Use esp-idf APIs instead of btStart * Another round of fixes * Start implementing ESP8266 * Make test3 compile * Guard esp8266 code * Lint * Reformat * Fixes * Fixes v2 * more fixes * ESP-IDF tidy target * Convert ARDUINO_ARCH_ESPxx * Update WiFiSignalSensor * Update time ifdefs * OTA needs millis from hal * RestartSwitch needs delay from hal * ESP-IDF Uart * Fix OTA blank password * Allow setting sdkconfig * Fix idf partitions and allow setting sdkconfig from yaml * Re-add read/write compat APIs and fix esp8266 uart * Fix esp8266 store log strings in flash * Fix ESP32 arduino preferences not initialized * Update ifdefs * Change how sdkconfig change is detected * Add checks to ci-custom and fix them * Run clang-format * Add esp-idf clang-tidy target and fix errors * Fixes from clang-tidy idf round 2 * Fixes from compiling tests with esp-idf * Run clang-format * Switch test5.yaml to esp-idf * Implement ESP8266 Preferences * Lint * Re-do PIO package version selection a bit * Fix arduinoespressif32 package version * Fix unit tests * Lint * Lint fixes * Fix readv/writev not defined * Fix graphing component * Re-add all old options from core/config.py Co-authored-by: Jesse Hills <3060199+jesserockz@users.noreply.github.com>
51 lines
1.5 KiB
C++
51 lines
1.5 KiB
C++
#include "stepper.h"
|
|
#include "esphome/core/log.h"
|
|
#include "esphome/core/hal.h"
|
|
|
|
namespace esphome {
|
|
namespace stepper {
|
|
|
|
static const char *const TAG = "stepper";
|
|
|
|
void Stepper::calculate_speed_(uint32_t now) {
|
|
// delta t since last calculation in seconds
|
|
float dt = (now - this->last_calculation_) * 1e-6f;
|
|
this->last_calculation_ = now;
|
|
if (this->has_reached_target()) {
|
|
this->current_speed_ = 0.0f;
|
|
return;
|
|
}
|
|
|
|
int32_t num_steps = abs(int32_t(this->target_position) - int32_t(this->current_position));
|
|
// (v_0)^2 / 2*a
|
|
float v_squared = this->current_speed_ * this->current_speed_;
|
|
auto steps_to_decelerate = static_cast<int32_t>(v_squared / (2 * this->deceleration_));
|
|
if (num_steps <= steps_to_decelerate) {
|
|
// need to start decelerating
|
|
this->current_speed_ -= this->deceleration_ * dt;
|
|
} else {
|
|
// we can still accelerate
|
|
this->current_speed_ += this->acceleration_ * dt;
|
|
}
|
|
this->current_speed_ = clamp(this->current_speed_, 0.0f, this->max_speed_);
|
|
}
|
|
int32_t Stepper::should_step_() {
|
|
uint32_t now = micros();
|
|
this->calculate_speed_(now);
|
|
if (this->current_speed_ == 0.0f)
|
|
return 0;
|
|
|
|
// assumes this method is called in a constant interval
|
|
uint32_t dt = now - this->last_step_;
|
|
if (dt >= (1 / this->current_speed_) * 1e6f) {
|
|
int32_t mag = this->target_position > this->current_position ? 1 : -1;
|
|
this->last_step_ = now;
|
|
this->current_position += mag;
|
|
return mag;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
} // namespace stepper
|
|
} // namespace esphome
|