- Added and updated svg files used in docs

- minor change in speed_table calculation
This commit is contained in:
1nct committed 2022-08-01 21:28:06 +02:00
1 parent fd017ea685
commit c8eece795f
13 files changed
+25444 -24296

No files matched your search

+5 -4
View File
@@ -220,13 +220,14 @@ void init_pid(pid_params *pid){
double v_min = (double)CV_ARRAY_FLASH[1];
double v_mid = (double)CV_ARRAY_FLASH[5]*16;
double v_max = (double)CV_ARRAY_FLASH[4]*16;
double m_1 = (v_mid-v_min)/62;
double m_2 = (v_max-v_mid)/63;
double delta_x = 63;
double m_1 = (v_mid-v_min)/delta_x;
double m_2 = (v_max-v_mid)/delta_x;
pid->speed_table[0] = 0;
for (uint8_t i = 1; i < 63; ++i) {
for (uint8_t i = 1; i < 64; ++i) {
pid->speed_table[i] = (uint16_t)lround(m_1*(i-1)+v_min);
}
for (uint8_t i = 63; i < 127; ++i) {
for (uint8_t i = 64; i < 127; ++i) {
pid->speed_table[i] = (uint16_t)lround(m_2*(i-63)+v_mid);
}