Files
esphome-dev/esphome/components/stepper/stepper.cpp
T
Otto Winter 6682c43dfa 🏗 Merge C++ into python codebase (#504)
## Description:

Move esphome-core codebase into esphome (and a bunch of other refactors). See https://github.com/esphome/feature-requests/issues/97

Yes this is a shit ton of work and no there's no way to automate it :( But it will be worth it 👍

Progress:
- Core support (file copy etc): 80%
- Base Abstractions (light, switch): ~50%
- Integrations: ~10%
- Working? Yes, (but only with ported components).

Other refactors:
- Moves all codegen related stuff into a single class: `esphome.codegen` (imported as `cg`)
- Rework coroutine syntax
- Move from `component/platform.py` to `domain/component.py` structure as with HA
- Move all defaults out of C++ and into config validation.
- Remove `make_...` helpers from Application class. Reason: Merge conflicts with every single new integration.
- Pointer Variables are stored globally instead of locally in setup(). Reason: stack size limit.

Future work:
- Rework const.py - Move all `CONF_...` into a conf class (usage `conf.UPDATE_INTERVAL` vs `CONF_UPDATE_INTERVAL`). Reason: Less convoluted import block
- Enable loading from `custom_components` folder.

**Related issue (if applicable):** https://github.com/esphome/feature-requests/issues/97

**Pull request in [esphome-docs](https://github.com/esphome/esphome-docs) with documentation (if applicable):** esphome/esphome-docs#<esphome-docs PR number goes here>

## Checklist:
  - [ ] The code change is tested and works locally.
  - [ ] Tests have been added to verify that the new code works (under `tests/` folder).

If user exposed functionality or configuration variables are added/changed:
  - [ ] Documentation added/updated in [esphomedocs](https://github.com/OttoWinter/esphomedocs).
2019-04-17 12:06:00 +02:00

51 lines
1.5 KiB
C++

#include "stepper.h"
#include "esphome/core/log.h"
namespace esphome {
namespace stepper {
static const char *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