blob: 27f28ac49102318b483e3c150da483e6091eb354 [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
Maxwell Hendersonce232a92024-02-18 12:17:37 -080035{% set climber_encoder_ratio = (16.0 / 60.0) %}
Maxwell Henderson3d68e142024-02-25 09:58:11 -080036{% set climber_circumference = 16.0 * 0.25 * 0.0254 %}
Filip Kujawa37aa0bc2024-01-31 20:59:49 -080037{%
38set climber_zero = {
39 "average_filter_size": zeroing_sample_size,
Maxwell Hendersonfa3bf292024-02-23 19:08:35 -080040 "one_revolution_distance": climber_encoder_ratio * climber_circumference,
Filip Kujawa37aa0bc2024-01-31 20:59:49 -080041 "zeroing_threshold": 0.0005,
42 "moving_buffer_size": 20,
43 "allowable_encoder_error": 0.9
44}
45%}
Niko Sohmers3bfe3d62024-02-18 16:09:49 -080046
47{# Catapult #}
48{% set catapult_encoder_ratio = (12.0 / 24.0) %}
49
50{%
51set catapult_zero = {
52 "average_filter_size": zeroing_sample_size,
53 "one_revolution_distance": pi * 2.0 * catapult_encoder_ratio,
54 "zeroing_threshold": 0.0005,
55 "moving_buffer_size": 20,
56 "allowable_encoder_error": 0.9
57}
58%}
59
60{# Altitude #}
61{% set altitude_encoder_ratio = (16.0 / 162.0) %}
62
63{%
64set altitude_zero = {
65 "average_filter_size": zeroing_sample_size,
66 "one_revolution_distance": pi * 2.0 * altitude_encoder_ratio,
67 "zeroing_threshold": 0.0005,
68 "moving_buffer_size": 20,
69 "allowable_encoder_error": 0.9
70}
71%}
72
73{# Turret #}
74{% set turret_encoder_ratio = (22.0 / 100.0) %}
75
76{%
77set turret_zero = {
78 "average_filter_size": zeroing_sample_size,
79 "one_revolution_distance": pi * 2.0 * turret_encoder_ratio,
80 "zeroing_threshold": 0.0005,
81 "moving_buffer_size": 20,
82 "allowable_encoder_error": 0.9
83}
84%}