Fix mapping output to use correct number of channels/cubes no matter what is in mappi...
[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 // Address to send to
20 private final NetAddress address;
21
22 // OSC message
23 private final OscMessage message;
24
25 // List of point indices on the board
26 private final int[] points;
27
28 // How many channels are on the panda board
29 private final static int CHANNELS_PER_BOARD = 8;
30
31 // How many cubes per channel xc_PB is configured for
32 private final static int CUBES_PER_CHANNEL = 4;
33
34 // Packet data
35 private final byte[] packet = new byte[4*352]; // TODO: de-magic-number, UDP related?
36
37 public PandaDriver(NetAddress address, Model model, int[][] channelList) {
38 this.address = address;
39 message = new OscMessage("/shady/pointbuffer");
40 List<Integer> pointList = buildMappedList(model, channelList);
41 points = new int[pointList.size()];
42 int i = 0;
43 for (int value : pointList) {
44 points[i++] = value;
45 }
46 }
47
48 private ArrayList<Integer> buildMappedList(Model model, int[][] channelList) {
49 ArrayList<Integer> points = new ArrayList<Integer>();
50 for (int chi = 0; chi < CHANNELS_PER_BOARD; ++chi) {
51 int[] channel = (chi < channelList.length) ? channelList[chi] : new int[]{};
52 for (int ci = 0; ci < CUBES_PER_CHANNEL; ++ci) {
53 int cubeNumber = (ci < channel.length) ? channel[ci] : 0;
54 if (cubeNumber == 0) {
55 for (int i = 0; i < (Cube.FACES_PER_CUBE*Face.STRIPS_PER_FACE*Strip.POINTS_PER_STRIP); ++i) {
56 points.add(0);
57 }
58 } else {
59 Cube cube = model.getCubeByRawIndex(cubeNumber);
60 if (cube == null) {
61 throw new RuntimeException("Non-zero, non-existing cube specified in channel mapping (" + cubeNumber + ")");
62 }
63 final int[] stripOrder = new int[] {
64 2, 1, 0, 3, 13, 12, 15, 14, 4, 7, 6, 5, 11, 10, 9, 8
65 };
66 for (int stripIndex : stripOrder) {
67 Strip s = cube.strips.get(stripIndex);
68 for (int j = s.points.size() - 1; j >= 0; --j) {
69 points.add(s.points.get(j).index);
70 }
71 }
72 }
73 }
74 }
75 return points;
76 }
77
78 public final void send(int[] colors) {
79 int len = 0;
80 int packetNum = 0;
81 for (int index : points) {
82 int c = colors[index];
83 byte r = (byte) ((c >> 16) & 0xFF);
84 byte g = (byte) ((c >> 8) & 0xFF);
85 byte b = (byte) ((c) & 0xFF);
86 packet[len++] = 0;
87 packet[len++] = r;
88 packet[len++] = g;
89 packet[len++] = b;
90
91 // Flush once packet is full buffer size
92 if (len >= packet.length) {
93 sendPacket(packetNum++);
94 len = 0;
95 }
96 }
97
98 // Flush any remaining data
99 if (len > 0) {
100 sendPacket(packetNum++);
101 }
102 }
103
104 private void sendPacket(int packetNum) {
105 message.clearArguments();
106 message.add(packetNum);
107 message.add(packet.length);
108 message.add(packet);
109 try {
110 OscP5.flush(message, address);
111 } catch (Exception x) {
112 x.printStackTrace();
113 }
114 }
115 }
116