blob: d01b45a4b03dba15125c52c492fe2adca397a69c [file] [log] [blame]
Maxwell Hendersonde14bbb2024-01-29 13:59:28 -08001{% set pi = 3.14159265 %}
2
Niko Sohmers3bfe3d62024-02-18 16:09:49 -08003{%set zeroing_sample_size = 200 %}
4
5{# Intake #}
Maxwell Hendersonde14bbb2024-01-29 13:59:28 -08006{# we do this here so we keep the encoder ratio in plaintext and also keep the math we're using. #}
Maxwell Hendersonca7c9b62024-02-21 13:20:09 -08007{% set intake_pivot_encoder_ratio = (15.0 / 24.0) %}
8
Maxwell Henderson3d68e142024-02-25 09:58:11 -08009{% set intake_upper = 1.75 %}
10{% set intake_lower = -0.195 %}
Maxwell Hendersonde14bbb2024-01-29 13:59:28 -080011
Maxwell Hendersonde14bbb2024-01-29 13:59:28 -080012{%
13set intake_pivot_zero = {
14 "average_filter_size": zeroing_sample_size,
15 "one_revolution_distance": pi * 2.0 * intake_pivot_encoder_ratio,
Maxwell Hendersonca7c9b62024-02-21 13:20:09 -080016 "middle_position": (intake_upper + intake_lower) / 2,
Maxwell Hendersonde14bbb2024-01-29 13:59:28 -080017 "zeroing_threshold": 0.0005,
18 "moving_buffer_size": 20,
19 "allowable_encoder_error": 0.9
20}
21%}
Filip Kujawa37aa0bc2024-01-31 20:59:49 -080022
Austin Schuh3db875a2024-02-18 20:02:40 -080023{% set extend_encoder_ratio = (1.0 / 1.0) %}
24{% set extend_radius = 36.0 * 0.005 / 2.0 / pi %}
25{%
26set extend_zero = {
27 "average_filter_size": zeroing_sample_size,
28 "one_revolution_distance": pi * 2.0 * extend_encoder_ratio * extend_radius,
29 "zeroing_threshold": 0.0005,
30 "moving_buffer_size": 20,
31 "allowable_encoder_error": 0.9
32}
33%}
34
Niko Sohmers3bfe3d62024-02-18 16:09:49 -080035{# Catapult #}
36{% set catapult_encoder_ratio = (12.0 / 24.0) %}
37
38{%
39set catapult_zero = {
40 "average_filter_size": zeroing_sample_size,
41 "one_revolution_distance": pi * 2.0 * catapult_encoder_ratio,
42 "zeroing_threshold": 0.0005,
43 "moving_buffer_size": 20,
44 "allowable_encoder_error": 0.9
45}
46%}
47
48{# Altitude #}
49{% set altitude_encoder_ratio = (16.0 / 162.0) %}
50
51{%
52set altitude_zero = {
53 "average_filter_size": zeroing_sample_size,
54 "one_revolution_distance": pi * 2.0 * altitude_encoder_ratio,
55 "zeroing_threshold": 0.0005,
56 "moving_buffer_size": 20,
57 "allowable_encoder_error": 0.9
58}
59%}
60
61{# Turret #}
62{% set turret_encoder_ratio = (22.0 / 100.0) %}
63
64{%
65set turret_zero = {
66 "average_filter_size": zeroing_sample_size,
67 "one_revolution_distance": pi * 2.0 * turret_encoder_ratio,
68 "zeroing_threshold": 0.0005,
69 "moving_buffer_size": 20,
70 "allowable_encoder_error": 0.9
71}
72%}