Commit | Line | Data |
---|---|---|
e73ef85d MS |
1 | import netP5.*; |
2 | import oscP5.*; | |
3 | ||
4 | /** | |
5 | * DOUBLE BLACK DIAMOND DOUBLE BLACK DIAMOND | |
6 | * | |
7 | * //\\ //\\ //\\ //\\ | |
8 | * ///\\\ ///\\\ ///\\\ ///\\\ | |
9 | * \\\/// \\\/// \\\/// \\\/// | |
10 | * \\// \\// \\// \\// | |
11 | * | |
12 | * EXPERTS ONLY!! EXPERTS ONLY!! | |
13 | * | |
14 | * This class implements the output function to the Panda Boards. It | |
15 | * will be moved into GLucose once stabilized. | |
16 | */ | |
17 | public class PandaDriver { | |
18 | ||
79ae8245 MS |
19 | // IP address |
20 | public final String ip; | |
21 | ||
e73ef85d MS |
22 | // Address to send to |
23 | private final NetAddress address; | |
24 | ||
79ae8245 MS |
25 | // Whether board output is enabled |
26 | private boolean enabled = false; | |
27 | ||
e73ef85d MS |
28 | // OSC message |
29 | private final OscMessage message; | |
30 | ||
31 | // List of point indices on the board | |
e4d0d812 | 32 | private final int[] points; |
44b8de9c | 33 | |
e73ef85d | 34 | // Packet data |
b0071f51 | 35 | private final byte[] packet = new byte[4*352]; // TODO: de-magic-number, UDP related? |
e73ef85d | 36 | |
44b8de9c | 37 | public PandaDriver(String ip) { |
79ae8245 MS |
38 | this.ip = ip; |
39 | this.address = new NetAddress(ip, 9001); | |
e73ef85d | 40 | message = new OscMessage("/shady/pointbuffer"); |
44b8de9c MS |
41 | points = new int[PandaMapping.PIXELS_PER_BOARD]; |
42 | for (int i = 0; i < points.length; ++i) { | |
43 | points[i] = 0; | |
44 | } | |
45 | } | |
46 | ||
47 | public PandaDriver(String ip, int[] pointList) { | |
48 | this(ip); | |
49 | for (int i = 0; i < pointList.length && i < points.length; ++i) { | |
50 | this.points[i] = pointList[i]; | |
e4d0d812 | 51 | } |
e73ef85d | 52 | } |
44b8de9c MS |
53 | |
54 | public PandaDriver(String ip, Model model, PandaMapping pm) { | |
55 | this(ip); | |
56 | buildPointList(model, pm); | |
57 | } | |
79ae8245 MS |
58 | |
59 | public void toggle() { | |
60 | enabled = !enabled; | |
045b432d | 61 | println("PandaBoard/" + ip + ": " + (enabled ? "ON" : "OFF")); |
79ae8245 | 62 | } |
e73ef85d | 63 | |
44b8de9c | 64 | private void buildPointList(Model model, PandaMapping pm) { |
68dcffde MS |
65 | final int[][] stripOrderings = new int[][] { |
66 | { 2, 1, 0, 3, 13, 12, 15, 14, 4, 7, 6, 5, 11, 10, 9, 8 }, // FRONT_LEFT | |
67 | { 6, 5, 4, 7, 1, 0, 3, 2, 8, 11, 10, 9, 15, 14, 13, 12 }, // FRONT_RIGHT | |
68 | { 14, 13, 12, 15, 9, 8, 11, 10, 0, 3, 2, 1, 7, 6, 5, 4 }, // REAR_LEFT | |
69 | { 10, 9, 8, 11, 5, 4, 7, 6, 12, 15, 14, 13, 3, 2, 1, 0 }, // REAR_RIGHT | |
70 | }; | |
71 | ||
44b8de9c MS |
72 | int pi = 0; |
73 | for (int[] channel : pm.channelList) { | |
045b432d | 74 | for (int cubeNumber : channel) { |
44b8de9c | 75 | if (cubeNumber <= 0) { |
cdb88d5d | 76 | for (int i = 0; i < Cube.POINTS_PER_CUBE; ++i) { |
44b8de9c | 77 | points[pi++] = 0; |
e73ef85d MS |
78 | } |
79 | } else { | |
80 | Cube cube = model.getCubeByRawIndex(cubeNumber); | |
81 | if (cube == null) { | |
82 | throw new RuntimeException("Non-zero, non-existing cube specified in channel mapping (" + cubeNumber + ")"); | |
83 | } | |
68dcffde MS |
84 | int stripOrderIndex = 0; |
85 | switch (cube.wiring) { | |
86 | case FRONT_LEFT: stripOrderIndex = 0; break; | |
87 | case FRONT_RIGHT: stripOrderIndex = 1; break; | |
88 | case REAR_LEFT: stripOrderIndex = 2; break; | |
89 | case REAR_RIGHT: stripOrderIndex = 3; break; | |
90 | } | |
91 | for (int stripIndex : stripOrderings[stripOrderIndex]) { | |
bfff6bc2 MS |
92 | Strip s = cube.strips.get(stripIndex); |
93 | for (int j = s.points.size() - 1; j >= 0; --j) { | |
44b8de9c | 94 | points[pi++] = s.points.get(j).index; |
bfff6bc2 | 95 | } |
e73ef85d MS |
96 | } |
97 | } | |
98 | } | |
99 | } | |
e73ef85d MS |
100 | } |
101 | ||
e73ef85d | 102 | public final void send(int[] colors) { |
79ae8245 MS |
103 | if (!enabled) { |
104 | return; | |
105 | } | |
e73ef85d MS |
106 | int len = 0; |
107 | int packetNum = 0; | |
108 | for (int index : points) { | |
109 | int c = colors[index]; | |
110 | byte r = (byte) ((c >> 16) & 0xFF); | |
111 | byte g = (byte) ((c >> 8) & 0xFF); | |
112 | byte b = (byte) ((c) & 0xFF); | |
e73ef85d MS |
113 | packet[len++] = 0; |
114 | packet[len++] = r; | |
115 | packet[len++] = g; | |
116 | packet[len++] = b; | |
117 | ||
118 | // Flush once packet is full buffer size | |
119 | if (len >= packet.length) { | |
f584b5eb | 120 | sendPacket(packetNum++); |
e73ef85d MS |
121 | len = 0; |
122 | } | |
123 | } | |
124 | ||
125 | // Flush any remaining data | |
126 | if (len > 0) { | |
f584b5eb | 127 | sendPacket(packetNum++); |
e73ef85d MS |
128 | } |
129 | } | |
130 | ||
f584b5eb | 131 | private void sendPacket(int packetNum) { |
e73ef85d MS |
132 | message.clearArguments(); |
133 | message.add(packetNum); | |
f584b5eb | 134 | message.add(packet.length); |
e73ef85d MS |
135 | message.add(packet); |
136 | try { | |
bfff6bc2 | 137 | OscP5.flush(message, address); |
e73ef85d MS |
138 | } catch (Exception x) { |
139 | x.printStackTrace(); | |
140 | } | |
141 | } | |
142 | } | |
143 |