Update mapping and debugging tools to support bassbin, speakers, and booth floor
[SugarCubes.git] / _PandaDriver.pde
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
19 // IP address
20 public final String ip;
21
22 // Address to send to
23 private final NetAddress address;
24
25 // Whether board output is enabled
26 private boolean enabled = false;
27
28 // OSC message
29 private final OscMessage message;
30
31 // List of point indices on the board
32 private final int[] points;
33
34 // Packet data
35 private final byte[] packet = new byte[4*352]; // TODO: de-magic-number, UDP related?
36
37 private static final int NO_POINT = -1;
38
39 public PandaDriver(String ip) {
40 this.ip = ip;
41 this.address = new NetAddress(ip, 9001);
42 message = new OscMessage("/shady/pointbuffer");
43 points = new int[PandaMapping.PIXELS_PER_BOARD];
44 for (int i = 0; i < points.length; ++i) {
45 points[i] = 0;
46 }
47 }
48
49 public PandaDriver(String ip, int[] pointList) {
50 this(ip);
51 for (int i = 0; i < pointList.length && i < points.length; ++i) {
52 this.points[i] = pointList[i];
53 }
54 }
55
56 public PandaDriver(String ip, Model model, PandaMapping pm) {
57 this(ip);
58 buildPointList(model, pm);
59 }
60
61 public void toggle() {
62 enabled = !enabled;
63 println("PandaBoard/" + ip + ": " + (enabled ? "ON" : "OFF"));
64 }
65
66 private void buildPointList(Model model, PandaMapping pm) {
67 final int[][] stripOrderings = new int[][] {
68 { 2, 1, 0, 3, 13, 12, 15, 14, 4, 7, 6, 5, 11, 10, 9, 8 }, // FRONT_LEFT
69 { 6, 5, 4, 7, 1, 0, 3, 2, 8, 11, 10, 9, 15, 14, 13, 12 }, // FRONT_RIGHT
70 { 14, 13, 12, 15, 9, 8, 11, 10, 0, 3, 2, 1, 7, 6, 5, 4 }, // REAR_LEFT
71 { 10, 9, 8, 11, 5, 4, 7, 6, 12, 15, 14, 13, 3, 2, 1, 0 }, // REAR_RIGHT
72 };
73
74 int pi = 0;
75 for (ChannelMapping channel : pm.channelList) {
76 switch (channel.mode) {
77 case ChannelMapping.MODE_CUBES:
78 for (int rawCubeIndex : channel.objectIndices) {
79 if (rawCubeIndex < 0) {
80 for (int i = 0; i < Cube.POINTS_PER_CUBE; ++i) {
81 points[pi++] = NO_POINT;
82 }
83 } else {
84 Cube cube = model.getCubeByRawIndex(rawCubeIndex);
85 int stripOrderIndex = 0;
86 switch (cube.wiring) {
87 case FRONT_LEFT: stripOrderIndex = 0; break;
88 case FRONT_RIGHT: stripOrderIndex = 1; break;
89 case REAR_LEFT: stripOrderIndex = 2; break;
90 case REAR_RIGHT: stripOrderIndex = 3; break;
91 }
92 for (int stripIndex : stripOrderings[stripOrderIndex]) {
93 Strip s = cube.strips.get(stripIndex);
94 for (int j = s.points.size() - 1; j >= 0; --j) {
95 points[pi++] = s.points.get(j).index;
96 }
97 }
98 }
99 }
100 break;
101
102 case ChannelMapping.MODE_BASS:
103 // TODO(mapping): figure out how these strips are wired
104 for (int i = 0; i < ChannelMapping.PIXELS_PER_CHANNEL; ++i) {
105 points[pi++] = NO_POINT;
106 }
107 break;
108
109 case ChannelMapping.MODE_FLOOR:
110 // TODO(mapping): figure out how these strips are wired
111 for (int i = 0; i < ChannelMapping.PIXELS_PER_CHANNEL; ++i) {
112 points[pi++] = NO_POINT;
113 }
114 break;
115
116 case ChannelMapping.MODE_SPEAKER:
117 // TODO(mapping): figure out how these strips are wired
118 for (int i = 0; i < ChannelMapping.PIXELS_PER_CHANNEL; ++i) {
119 points[pi++] = NO_POINT;
120 }
121 break;
122
123 case ChannelMapping.MODE_NULL:
124 for (int i = 0; i < ChannelMapping.PIXELS_PER_CHANNEL; ++i) {
125 points[pi++] = NO_POINT;
126 }
127 break;
128
129 default:
130 throw new RuntimeException("Invalid/unhandled channel mapping mode: " + channel.mode);
131 }
132 }
133 }
134
135 public final void send(int[] colors) {
136 if (!enabled) {
137 return;
138 }
139 int len = 0;
140 int packetNum = 0;
141 for (int index : points) {
142 int c = (index < 0) ? 0 : colors[index];
143 byte r = (byte) ((c >> 16) & 0xFF);
144 byte g = (byte) ((c >> 8) & 0xFF);
145 byte b = (byte) ((c) & 0xFF);
146 packet[len++] = 0;
147 packet[len++] = r;
148 packet[len++] = g;
149 packet[len++] = b;
150
151 // Flush once packet is full buffer size
152 if (len >= packet.length) {
153 sendPacket(packetNum++);
154 len = 0;
155 }
156 }
157
158 // Flush any remaining data
159 if (len > 0) {
160 sendPacket(packetNum++);
161 }
162 }
163
164 private void sendPacket(int packetNum) {
165 message.clearArguments();
166 message.add(packetNum);
167 message.add(packet.length);
168 message.add(packet);
169 try {
170 OscP5.flush(message, address);
171 } catch (Exception x) {
172 x.printStackTrace();
173 }
174 }
175 }
176