blob: cb663fac41f07060df68908a8fcfdd42ff1386a4 [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. #}
Niko Sohmers77013322024-02-09 20:17:16 -08007{% set intake_pivot_encoder_ratio = (24.0 / 15.0) %}
Maxwell Hendersonde14bbb2024-01-29 13:59:28 -08008
Maxwell Hendersonde14bbb2024-01-29 13:59:28 -08009{%
10set intake_pivot_zero = {
11 "average_filter_size": zeroing_sample_size,
12 "one_revolution_distance": pi * 2.0 * intake_pivot_encoder_ratio,
13 "zeroing_threshold": 0.0005,
14 "moving_buffer_size": 20,
15 "allowable_encoder_error": 0.9
16}
17%}
Filip Kujawa37aa0bc2024-01-31 20:59:49 -080018
Maxwell Hendersonce232a92024-02-18 12:17:37 -080019{% set climber_encoder_ratio = (16.0 / 60.0) %}
20{% set climber_radius = 16.0 * 0.25 / 2.0 / pi %}
Filip Kujawa37aa0bc2024-01-31 20:59:49 -080021{%
22set climber_zero = {
23 "average_filter_size": zeroing_sample_size,
24 "one_revolution_distance": pi * 2.0 * climber_encoder_ratio * climber_radius,
25 "zeroing_threshold": 0.0005,
26 "moving_buffer_size": 20,
27 "allowable_encoder_error": 0.9
28}
29%}
Niko Sohmers3bfe3d62024-02-18 16:09:49 -080030
31{# Catapult #}
32{% set catapult_encoder_ratio = (12.0 / 24.0) %}
33
34{%
35set catapult_zero = {
36 "average_filter_size": zeroing_sample_size,
37 "one_revolution_distance": pi * 2.0 * catapult_encoder_ratio,
38 "zeroing_threshold": 0.0005,
39 "moving_buffer_size": 20,
40 "allowable_encoder_error": 0.9
41}
42%}
43
44{# Altitude #}
45{% set altitude_encoder_ratio = (16.0 / 162.0) %}
46
47{%
48set altitude_zero = {
49 "average_filter_size": zeroing_sample_size,
50 "one_revolution_distance": pi * 2.0 * altitude_encoder_ratio,
51 "zeroing_threshold": 0.0005,
52 "moving_buffer_size": 20,
53 "allowable_encoder_error": 0.9
54}
55%}
56
57{# Turret #}
58{% set turret_encoder_ratio = (22.0 / 100.0) %}
59
60{%
61set turret_zero = {
62 "average_filter_size": zeroing_sample_size,
63 "one_revolution_distance": pi * 2.0 * turret_encoder_ratio,
64 "zeroing_threshold": 0.0005,
65 "moving_buffer_size": 20,
66 "allowable_encoder_error": 0.9
67}
68%}