blob: d2ac3dc2a89885b83dc522c9887dc3c3d1292686 [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
9{% set intake_upper = 2.1 %}
10{% set intake_lower = 0.1 %}
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) %}
36{% set climber_radius = 16.0 * 0.25 / 2.0 / pi %}
Filip Kujawa37aa0bc2024-01-31 20:59:49 -080037{%
38set climber_zero = {
39 "average_filter_size": zeroing_sample_size,
40 "one_revolution_distance": pi * 2.0 * climber_encoder_ratio * climber_radius,
41 "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%}