1
1
Fork 0
VMC_Processing_Step1/VMC_Processing_Step1.pde

108 lines
3.3 KiB
Text

import ketai.sensors.*;
// Change this value to disable the Graph
boolean enableGraph = true;
KetaiSensor sensor;
float fontSize = 130*displayDensity;
float accelerometerX, accelerometerY, accelerometerZ, rotationX, rotationY, rotationZ;
ArrayList<Integer> valuesAccelX = new ArrayList<Integer>();
ArrayList<Integer> valuesAccelY = new ArrayList<Integer>();
ArrayList<Integer> valuesAccelZ = new ArrayList<Integer>();
ArrayList<Integer> valuesRotX = new ArrayList<Integer>();
ArrayList<Integer> valuesRotY = new ArrayList<Integer>();
ArrayList<Integer> valuesRotZ = new ArrayList<Integer>();
void setup()
{
sensor = new KetaiSensor(this);
sensor.start();
textAlign(CENTER, CENTER);
textSize(fontSize);
strokeWeight(6);
smooth();
}
float mapNum;
void draw()
{
background(78, 93, 75);
drawGraph(valuesAccelX, height / 2 - fontSize * 4);
drawGraph(valuesAccelY, height / 2 - fontSize * 3);
drawGraph(valuesAccelZ, height / 2 - fontSize * 2);
drawGraph(valuesRotX, height / 2 + fontSize * 3);
drawGraph(valuesRotY, height / 2 + fontSize * 4);
drawGraph(valuesRotZ, height / 2 + fontSize * 5);
fill(255);
text("Accelerometer:", 0, -fontSize*5.5, width, height);
mapNum = mapColor(accelerometerX);
fill(mapNum, 255-mapNum, 0);
text("x: " + nfp(accelerometerX, 1, 3), 0, -fontSize*4, width, height);
mapNum = mapColor(accelerometerY);
fill(mapNum, 255-mapNum, 0);
text("y: " + nfp(accelerometerY, 1, 3), 0, -fontSize*3, width, height);
mapNum = mapColor(accelerometerZ);
fill(mapNum, 255-mapNum, 0);
text("z: " + nfp(accelerometerZ, 1, 3), 0, -fontSize*2, width, height);
fill(255);
text("Gyroscope:", 0, fontSize*1.5, width, height);
mapNum = mapColor(rotationX);
fill(mapNum, 255-mapNum, 0);
text("x: " + nfp(rotationX, 1, 3), 0, fontSize*3, width, height);
mapNum = mapColor(rotationY);
fill(mapNum, 255-mapNum, 0);
text("y: " + nfp(rotationY, 1, 3), 0, fontSize*4, width, height);
mapNum = mapColor(rotationZ);
fill(mapNum, 255-mapNum, 0);
text("z: " + nfp(rotationZ, 1, 3), 0, fontSize*5, width, height);
}
float mapColor(float in){
return map(in, -9.83, 9.83, 0, 255);
}
void drawGraph(ArrayList<Integer> values, float margin){
if(!enableGraph) return;
float lineWidth = (float) width / (values.size() - 1);
for (int i=0; i < values.size() - 1; i++) {
line(i * lineWidth, margin + values.get(i), (i + 1) * lineWidth, margin + values.get(i + 1));
}
}
void onAccelerometerEvent(float x, float y, float z)
{
valuesAccelX.add(int(x * 10));
while(valuesAccelX.size() > 10)
valuesAccelX.remove(0);
valuesAccelY.add(int(y * 10));
while(valuesAccelY.size() > 10)
valuesAccelY.remove(0);
valuesAccelZ.add(int(z * 10));
while(valuesAccelZ.size() > 10)
valuesAccelZ.remove(0);
accelerometerX = x;
accelerometerY = y;
accelerometerZ = z;
}
void onGyroscopeEvent(float x, float y, float z)
{
valuesRotX.add(int(x * 10));
while(valuesRotX.size() > 10)
valuesRotX.remove(0);
valuesRotY.add(int(y * 10));
while(valuesRotY.size() > 10)
valuesRotY.remove(0);
valuesRotZ.add(int(z * 10));
while(valuesRotZ.size() > 10)
valuesRotZ.remove(0);
rotationX = x;
rotationY = y;
rotationZ = z;
}