-println( cubeangle.x + cubeangle.y + cubeangle.z);
-PVector cubecenterf = new PVector(cubecenter.x + tan(c.rx)*CW/2, cubecenter.y + tan(c.ry)*CH/2, cubecenter.z + tan(c.rz)*CW/2);
-
-return cubecenterf;
+println( "norm"+ cubeangle.x + "norm" + cubeangle.y +"norm" + cubeangle.z);
+PVector cubecenter = PVector.add(cubeorigin.get(i), PVector.mult(cubeangle, diag));
+
+//PVector cubecenter = new PVector(c.x+ CW/2, c.y + CH/2, c.z + CW/2);
+//println("cubecenter raw" + " : " + cubecenter.x + " " + cubecenter.y + " " + cubecenter.z );
+//PVector cubecenterf = new PVector(cubecenter.x + cos(c.ry)*CW/2, cubecenter.y , cubecenter.z - tan(c.ry) * CW/2);
+//println("cubecenter angled" + " : " + cubecenterf.x + " " + cubecenterf.y + " " + cubecenterf.z );
+return cubecenter;