Change mapping and debug tools to be generic, panda mappings totally generic
[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 // How many channels are on the panda board
35 private final static int CHANNELS_PER_BOARD = 8;
36
37 // How many cubes per channel xc_PB is configured for
38 private final static int CUBES_PER_CHANNEL = 4;
39
40 // Packet data
41 private final byte[] packet = new byte[4*352]; // TODO: de-magic-number, UDP related?
42
43 public PandaDriver(String ip, Model model, int[][] channelList) {
44 this.ip = ip;
45 this.address = new NetAddress(ip, 9001);
46 message = new OscMessage("/shady/pointbuffer");
47 List<Integer> pointList = buildMappedList(model, channelList);
48 points = new int[pointList.size()];
49 int i = 0;
50 for (int value : pointList) {
51 points[i++] = value;
52 }
53 }
54
55 public void toggle() {
56 enabled = !enabled;
57 println("PandaBoard Output/" + ip + ": " + (enabled ? "ON" : "OFF"));
58 }
59
60 private ArrayList<Integer> buildMappedList(Model model, int[][] channelList) {
61 ArrayList<Integer> points = new ArrayList<Integer>();
62 for (int chi = 0; chi < CHANNELS_PER_BOARD; ++chi) {
63 int[] channel = (chi < channelList.length) ? channelList[chi] : new int[]{};
64 for (int ci = 0; ci < CUBES_PER_CHANNEL; ++ci) {
65 int cubeNumber = (ci < channel.length) ? channel[ci] : 0;
66 if (cubeNumber == 0) {
67 for (int i = 0; i < Cube.POINTS_PER_CUBE; ++i) {
68 points.add(0);
69 }
70 } else {
71 Cube cube = model.getCubeByRawIndex(cubeNumber);
72 if (cube == null) {
73 throw new RuntimeException("Non-zero, non-existing cube specified in channel mapping (" + cubeNumber + ")");
74 }
75 final int[] stripOrder = new int[] {
76 2, 1, 0, 3, 13, 12, 15, 14, 4, 7, 6, 5, 11, 10, 9, 8
77 };
78 for (int stripIndex : stripOrder) {
79 Strip s = cube.strips.get(stripIndex);
80 for (int j = s.points.size() - 1; j >= 0; --j) {
81 points.add(s.points.get(j).index);
82 }
83 }
84 }
85 }
86 }
87 return points;
88 }
89
90 public final void send(int[] colors) {
91 if (!enabled) {
92 return;
93 }
94 int len = 0;
95 int packetNum = 0;
96 for (int index : points) {
97 int c = colors[index];
98 byte r = (byte) ((c >> 16) & 0xFF);
99 byte g = (byte) ((c >> 8) & 0xFF);
100 byte b = (byte) ((c) & 0xFF);
101 packet[len++] = 0;
102 packet[len++] = r;
103 packet[len++] = g;
104 packet[len++] = b;
105
106 // Flush once packet is full buffer size
107 if (len >= packet.length) {
108 sendPacket(packetNum++);
109 len = 0;
110 }
111 }
112
113 // Flush any remaining data
114 if (len > 0) {
115 sendPacket(packetNum++);
116 }
117 }
118
119 private void sendPacket(int packetNum) {
120 message.clearArguments();
121 message.add(packetNum);
122 message.add(packet.length);
123 message.add(packet);
124 try {
125 OscP5.flush(message, address);
126 } catch (Exception x) {
127 x.printStackTrace();
128 }
129 }
130 }
131