LER-2025/src/main/java/frc/robot/IDLookUp.java at 55b0351005d5ca9bfeb2742c3a6509a42b7c65c2 · LakeEffectRobotics/LER-2025 · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
package frc.robot;

public class IDLookUp {
    public static double getIdAngle(int id) {
	double output = 0.0;
	switch (id) {
	case 6:
	    output = Math.toRadians(300.0);
	    break;
	case 7:
	    output = Math.toRadians(0.0);
	    break;
	case 8:
	    output = Math.toRadians(60.0);
	    break;
	case 9:
	    output = Math.toRadians(120.0);
	    break;
	case 10:
	    output = Math.toRadians(180.0);
	    break;
	case 11:
	    output = Math.toRadians(240.0);
	    break;
	case 17:
	    output = Math.toRadians(60.0);
	    break;
	case 18:
	    output = Math.toRadians(0.0);
	    break;
	case 19:
	    output = Math.toRadians(300.0);
	    break;
	case 20:
	    output = Math.toRadians(240.0);
	    break;
	case 21:
	    output = Math.toRadians(180.0);
	    break;
	case 22:
	    output = Math.toRadians(120.0);
	    break;
	default:
	    output = Math.toRadians(0.0);
	    break;
	}
	return output;

    }
}