added asynchronous timer
This commit is contained in:
parent
53879d6546
commit
62666ebb8c
6 changed files with 608 additions and 505 deletions
|
|
@ -1,20 +1,16 @@
|
|||
// WIP. 3/28/2022: added test state machine. Need to re-write moving to next state
|
||||
// WIP. 4/4/2022: started to implement delay timer asyncronously using existing timer2 interrupt.
|
||||
|
||||
#include "config.h"
|
||||
#include "cubeplex.h"
|
||||
#include <timer.h>
|
||||
|
||||
Timer animationDelay;
|
||||
bool animationDelayTiming = false;
|
||||
|
||||
int color = red;
|
||||
|
||||
|
||||
void setup() {
|
||||
Serial.begin(115200);
|
||||
Serial.println("start program...");
|
||||
initCube();
|
||||
timerInit();
|
||||
//timerInit();
|
||||
|
||||
currentState = CHASETHEDOT;
|
||||
lastState = -1;
|
||||
|
|
@ -29,13 +25,14 @@ void loop() {
|
|||
|
||||
case CHASETHEDOT:
|
||||
chaseTheDot();
|
||||
//currentState = PLANARFLOP3D;
|
||||
break;
|
||||
|
||||
case RANDOMRAINBOW:
|
||||
rainbow_random();
|
||||
break;
|
||||
|
||||
case PLANARFLOP3D:
|
||||
planarFlop3D();
|
||||
//currentState = CHASETHEDOT;
|
||||
break;
|
||||
}
|
||||
animationDelay.update();
|
||||
}
|
||||
|
|
|
|||
|
|
@ -1,9 +1,11 @@
|
|||
/******************************** CHASE THE DOT *******************************\
|
||||
/******************************** CHASE THE DOT *******************************\
|
||||
| A single point of light moves around the cube randomly and changes colors |
|
||||
| when it tries to go out of bounds |
|
||||
| |
|
||||
| Inspired By: Jonah Glick |
|
||||
| Written By: Asher Glick |
|
||||
| |
|
||||
| Modified By: S. Dugre to use asynchronous timer |
|
||||
\******************************************************************************/
|
||||
|
||||
int xpos = 0;
|
||||
|
|
@ -13,21 +15,23 @@ int zpos = 0;
|
|||
int animationSpeed = 100;
|
||||
|
||||
void chaseTheDot() {
|
||||
//continuePattern = true;
|
||||
|
||||
if (currentState != lastState) {
|
||||
|
||||
lastState = currentState;
|
||||
Serial.print("last State = ");
|
||||
Serial.println(lastState);
|
||||
Serial.print("New State = ");
|
||||
Serial.println(currentState);
|
||||
xpos = 0;
|
||||
ypos = 0;
|
||||
zpos = 0;
|
||||
|
||||
currentTimer = 0;
|
||||
maxTimer = 6250; // 100 ms
|
||||
}
|
||||
|
||||
|
||||
//while (continuePattern) {
|
||||
if ( not animationDelayTiming) {
|
||||
if ( timerReset) {
|
||||
switch (random(0, 6)) {
|
||||
case 0:
|
||||
if (xpos > 0) {
|
||||
|
|
@ -75,8 +79,12 @@ void chaseTheDot() {
|
|||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
animationDelay.start();
|
||||
animationDelayTiming = true;
|
||||
Serial.println("start timer");
|
||||
|
||||
//animationDelay.start();
|
||||
//animationDelayTiming = true;
|
||||
//Serial.println("start timer");
|
||||
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
}
|
||||
|
|
|
|||
3
config.h
3
config.h
|
|
@ -3,7 +3,10 @@
|
|||
|
||||
typedef enum STATE {
|
||||
CHASETHEDOT,
|
||||
RANDOMRAINBOW,
|
||||
PLANARFLOP3D
|
||||
};
|
||||
|
||||
STATE currentState, lastState;
|
||||
|
||||
bool timerReset = true;
|
||||
|
|
|
|||
794
cubeplex.h
794
cubeplex.h
|
|
@ -1,50 +1,50 @@
|
|||
/********************************** SIGNATURE *********************************\
|
||||
| ,, |
|
||||
| db `7MM |
|
||||
| ;MM: MM |
|
||||
| ,V^MM. ,pP"Ybd MMpMMMb. .gP"Ya `7Mb,od8 |
|
||||
| ,M `MM 8I `" MM MM ,M' Yb MM' "' |
|
||||
| AbmmmqMA `YMMMa. MM MM 8M"""""" MM |
|
||||
| A' VML L. I8 MM MM YM. , MM |
|
||||
| .AMA. .AMMA.M9mmmP'.JMML JMML.`Mbmmd'.JMML. |
|
||||
| |
|
||||
| |
|
||||
| ,, ,, |
|
||||
| .g8"""bgd `7MM db `7MM |
|
||||
| .dP' `M MM MM |
|
||||
| dM' ` MM `7MM ,p6"bo MM ,MP' |
|
||||
| MM MM MM 6M' OO MM ;Y |
|
||||
| MM. `7MMF' MM MM 8M MM;Mm |
|
||||
| `Mb. MM MM MM YM. , MM `Mb. |
|
||||
| `"bmmmdPY .JMML..JMML.YMbmd'.JMML. YA. |
|
||||
| |
|
||||
\******************************************************************************/
|
||||
| ,, |
|
||||
| db `7MM |
|
||||
| ;MM: MM |
|
||||
| ,V^MM. ,pP"Ybd MMpMMMb. .gP"Ya `7Mb,od8 |
|
||||
| ,M `MM 8I `" MM MM ,M' Yb MM' "' |
|
||||
| AbmmmqMA `YMMMa. MM MM 8M"""""" MM |
|
||||
| A' VML L. I8 MM MM YM. , MM |
|
||||
| .AMA. .AMMA.M9mmmP'.JMML JMML.`Mbmmd'.JMML. |
|
||||
| |
|
||||
| |
|
||||
| ,, ,, |
|
||||
| .g8"""bgd `7MM db `7MM |
|
||||
| .dP' `M MM MM |
|
||||
| dM' ` MM `7MM ,p6"bo MM ,MP' |
|
||||
| MM MM MM 6M' OO MM ;Y |
|
||||
| MM. `7MMF' MM MM 8M MM;Mm |
|
||||
| `Mb. MM MM MM YM. , MM `Mb. |
|
||||
| `"bmmmdPY .JMML..JMML.YMbmd'.JMML. YA. |
|
||||
| |
|
||||
\******************************************************************************/
|
||||
/*********************************** LICENCE **********************************\
|
||||
| Copyright (c) 2012, Asher Glick |
|
||||
| All rights reserved. |
|
||||
| |
|
||||
| Redistribution and use in source and binary forms, with or without |
|
||||
| modification, are permitted provided that the following conditions are met: |
|
||||
| |
|
||||
| * Redistributions of source code must retain the above copyright notice, |
|
||||
| this list of conditions and the following disclaimer. |
|
||||
| * Redistributions in binary form must reproduce the above copyright notice, |
|
||||
| this list of conditions and the following disclaimer in the documentation |
|
||||
| and/or other materials provided with the distribution. |
|
||||
| |
|
||||
| THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
|
||||
| AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
|
||||
| IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
|
||||
| ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE |
|
||||
| LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
|
||||
| CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
|
||||
| SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
|
||||
| INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
|
||||
| CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
|
||||
| ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
|
||||
| POSSIBILITY OF SUCH DAMAGE. |
|
||||
\******************************************************************************/
|
||||
/*********** Modified by S. Dugre to work w/ my hardware***********************/
|
||||
| Copyright (c) 2012, Asher Glick |
|
||||
| All rights reserved. |
|
||||
| |
|
||||
| Redistribution and use in source and binary forms, with or without |
|
||||
| modification, are permitted provided that the following conditions are met: |
|
||||
| |
|
||||
| * Redistributions of source code must retain the above copyright notice, |
|
||||
| this list of conditions and the following disclaimer. |
|
||||
| * Redistributions in binary form must reproduce the above copyright notice, |
|
||||
| this list of conditions and the following disclaimer in the documentation |
|
||||
| and/or other materials provided with the distribution. |
|
||||
| |
|
||||
| THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
|
||||
| AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
|
||||
| IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
|
||||
| ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE |
|
||||
| LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
|
||||
| CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
|
||||
| SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
|
||||
| INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
|
||||
| CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
|
||||
| ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
|
||||
| POSSIBILITY OF SUCH DAMAGE. |
|
||||
\******************************************************************************/
|
||||
/*********** Modified by S. Dugre to work w/ my hardware***********************/
|
||||
|
||||
#ifndef _CUBEPLEX_H_
|
||||
#define _CUBEPLEX_H_
|
||||
|
|
@ -54,7 +54,7 @@
|
|||
#include "mappings.h"
|
||||
#include "niceTimer.h"
|
||||
|
||||
struct _frame_light{
|
||||
struct _frame_light {
|
||||
char pin1;
|
||||
char pin2;
|
||||
struct _frame_light * next;
|
||||
|
|
@ -67,19 +67,19 @@ char * _cube_buffer;
|
|||
volatile bool continuePattern = false;
|
||||
|
||||
/********************************** INIT CUBE *********************************\
|
||||
| This function will allocate the memory required for the LED cube buffers. |
|
||||
| which is about 600bytes
|
||||
\******************************************************************************/
|
||||
| This function will allocate the memory required for the LED cube buffers. |
|
||||
| which is about 600bytes
|
||||
\******************************************************************************/
|
||||
void initCube() {
|
||||
_cube__frame = (_frame_light*)malloc(sizeof(_frame_light) * (BUFFERSIZE+1));
|
||||
_cube__frame = (_frame_light*)malloc(sizeof(_frame_light) * (BUFFERSIZE + 1));
|
||||
_cube_buffer = (char*)malloc(sizeof(char) * BUFFERSIZE);
|
||||
|
||||
for (int i = 0; i < BUFFERSIZE; i++) {
|
||||
_cube_buffer[i] = 0;
|
||||
}
|
||||
_cube__frame->next = _cube__frame;
|
||||
_cube__frame->pin1=0;
|
||||
_cube__frame->pin2=0;
|
||||
_cube__frame->pin1 = 0;
|
||||
_cube__frame->pin2 = 0;
|
||||
_cube_current_frame = _cube__frame;
|
||||
|
||||
|
||||
|
|
@ -93,14 +93,14 @@ void initCube() {
|
|||
enableTimer1OverflowInterrupt();
|
||||
setTimer1Mode (TIMER1_NORMAL);
|
||||
}
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
////////////////////////////// HELPER FUNCTIONS //////////////////////////////
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
////////////////////////////// HELPER FUNCTIONS //////////////////////////////
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
/******************************** CLEAR BUFFER ********************************\
|
||||
| This function will clear the buffer that you can write to, this will allow |
|
||||
| you to draw an eniterly new frame int othe buffer
|
||||
\******************************************************************************/
|
||||
| This function will clear the buffer that you can write to, this will allow |
|
||||
| you to draw an eniterly new frame int othe buffer
|
||||
\******************************************************************************/
|
||||
void clearBuffer () {
|
||||
for (int i = 0; i < BUFFERSIZE; i++) {
|
||||
_cube_buffer[i] = 0;
|
||||
|
|
@ -108,38 +108,44 @@ void clearBuffer () {
|
|||
}
|
||||
|
||||
/**************************** NEXT COLOR FUNCTIONS ****************************\
|
||||
| These functions cycle thorugh |
|
||||
| the three primary colors red, greed, and blue |
|
||||
| the secondary colors purple, teal, yellow (every pairing of two leds) |
|
||||
| the ALL THE COLORS (red,green,blue,purple,teal,yellow,white) |
|
||||
\******************************************************************************/
|
||||
int nextPrimaryColor(int color) { return (color+1)%3; }
|
||||
int nextSecondaryColor(int color) { return ((color+1)%3)+3; }
|
||||
int nextColor(int color) { return (color+1)%7; }
|
||||
| These functions cycle thorugh |
|
||||
| the three primary colors red, greed, and blue |
|
||||
| the secondary colors purple, teal, yellow (every pairing of two leds) |
|
||||
| the ALL THE COLORS (red,green,blue,purple,teal,yellow,white) |
|
||||
\******************************************************************************/
|
||||
int nextPrimaryColor(int color) {
|
||||
return (color + 1) % 3;
|
||||
}
|
||||
int nextSecondaryColor(int color) {
|
||||
return ((color + 1) % 3) + 3;
|
||||
}
|
||||
int nextColor(int color) {
|
||||
return (color + 1) % 7;
|
||||
}
|
||||
|
||||
/********************************** SWAP INT **********************************\
|
||||
| This function uses the fast xor swap to change the values of the two |
|
||||
| intigers passed into the function |
|
||||
\******************************************************************************/
|
||||
| This function uses the fast xor swap to change the values of the two |
|
||||
| intigers passed into the function |
|
||||
\******************************************************************************/
|
||||
void swapint(int & one, int & two) {
|
||||
one = one^two;
|
||||
two = one^two;
|
||||
one = one^two;
|
||||
one = one ^ two;
|
||||
two = one ^ two;
|
||||
one = one ^ two;
|
||||
}
|
||||
|
||||
/******************************* ROUND CLOSTEST *******************************\
|
||||
| This function takes in a numberator and denominator and rounds to the |
|
||||
| nearist number instead of trunkating. It does this by calculating an extra |
|
||||
| digit (this function should be changes to be more accurate) |
|
||||
\******************************************************************************/
|
||||
| This function takes in a numberator and denominator and rounds to the |
|
||||
| nearist number instead of trunkating. It does this by calculating an extra |
|
||||
| digit (this function should be changes to be more accurate) |
|
||||
\******************************************************************************/
|
||||
int roundClostest(int numerator, int denominator) {
|
||||
numerator = (numerator << 1)/denominator;
|
||||
int output = (numerator>>1) + (numerator % 2);
|
||||
numerator = (numerator << 1) / denominator;
|
||||
int output = (numerator >> 1) + (numerator % 2);
|
||||
return output;
|
||||
}
|
||||
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
/////////////////////////////////// DRAWING //////////////////////////////////
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
/////////////////////////////////// DRAWING //////////////////////////////////
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
#define B 0
|
||||
|
|
@ -161,188 +167,197 @@ int roundClostest(int numerator, int denominator) {
|
|||
#define off -7
|
||||
|
||||
/********************************** DRAW LED **********************************\
|
||||
| This function turns on leds at a specified position. Depending on which |
|
||||
| color this function turns on different colors of the LED |
|
||||
\******************************************************************************/
|
||||
| This function turns on leds at a specified position. Depending on which |
|
||||
| color this function turns on different colors of the LED |
|
||||
\******************************************************************************/
|
||||
void drawLed(int color, int brightness, int x, int y, int z) {
|
||||
|
||||
if ((color/3)==0) { // single color (red green blue)
|
||||
//_cube_buffer[(((color)%3)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
_cube_buffer[(((color)%3)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
_cube_buffer[(((color+1)%3)*64)+(x*16)+(y*4)+z] += 0;
|
||||
if ((color / 3) == 0) { // single color (red green blue)
|
||||
//_cube_buffer[(((color)%3)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
_cube_buffer[(((color) % 3) * 64) + (x * 16) + (y * 4) + z] += brightness;
|
||||
_cube_buffer[(((color + 1) % 3) * 64) + (x * 16) + (y * 4) + z] += 0;
|
||||
}
|
||||
else if ((color/3)==1) { // double color (teal yellow purple)
|
||||
_cube_buffer[(((color)%3)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
_cube_buffer[(((color+1)%3)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
else if ((color / 3) == 1) { // double color (teal yellow purple)
|
||||
_cube_buffer[(((color) % 3) * 64) + (x * 16) + (y * 4) + z] += brightness;
|
||||
_cube_buffer[(((color + 1) % 3) * 64) + (x * 16) + (y * 4) + z] += brightness;
|
||||
}
|
||||
else if (color == 6){ // all colors (white)
|
||||
_cube_buffer[((0)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
_cube_buffer[((1)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
_cube_buffer[((2)*64)+(x*16)+(y*4)+z] += brightness;
|
||||
else if (color == 6) { // all colors (white)
|
||||
_cube_buffer[((0) * 64) + (x * 16) + (y * 4) + z] += brightness;
|
||||
_cube_buffer[((1) * 64) + (x * 16) + (y * 4) + z] += brightness;
|
||||
_cube_buffer[((2) * 64) + (x * 16) + (y * 4) + z] += brightness;
|
||||
}
|
||||
else if (color == -7) {
|
||||
_cube_buffer[((0)*64)+(x*16)+(y*4)+z] = 0;
|
||||
_cube_buffer[((1)*64)+(x*16)+(y*4)+z] = 0;
|
||||
_cube_buffer[((2)*64)+(x*16)+(y*4)+z] = 0;
|
||||
_cube_buffer[((0) * 64) + (x * 16) + (y * 4) + z] = 0;
|
||||
_cube_buffer[((1) * 64) + (x * 16) + (y * 4) + z] = 0;
|
||||
_cube_buffer[((2) * 64) + (x * 16) + (y * 4) + z] = 0;
|
||||
}
|
||||
}
|
||||
void drawLed(int color, int x, int y, int z) {
|
||||
drawLed(color,255,x,y,z);
|
||||
drawLed(color, 255, x, y, z);
|
||||
}
|
||||
|
||||
/********************************** DRAW BOX **********************************\
|
||||
| This function will draw a filled in box of the specified color on the cube |
|
||||
\******************************************************************************/
|
||||
| This function will draw a filled in box of the specified color on the cube |
|
||||
\******************************************************************************/
|
||||
void drawBox(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
if (startx > endx) swapint(startx,endx);
|
||||
if (starty > endy) swapint(starty,endy);
|
||||
if (startz > endz) swapint(startz,endz);
|
||||
if (startx > endx) swapint(startx, endx);
|
||||
if (starty > endy) swapint(starty, endy);
|
||||
if (startz > endz) swapint(startz, endz);
|
||||
|
||||
for (int i = startx; i <= endx; i++) {
|
||||
for (int j = starty; j <= endy; j++) {
|
||||
for (int k = startz; k <= endz; k++) {
|
||||
drawLed(color,brightness,i,j,k);
|
||||
drawLed(color, brightness, i, j, k);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
void drawBox(int color, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
drawBox(color,8,startx,starty,startz,endx,endy,endz);
|
||||
drawBox(color, 8, startx, starty, startz, endx, endy, endz);
|
||||
}
|
||||
/******************************* DRAW HOLLOW BOX ******************************\
|
||||
| This function will draw the walls, celing, and floor of a defined box |
|
||||
\******************************************************************************/
|
||||
| This function will draw the walls, celing, and floor of a defined box |
|
||||
\******************************************************************************/
|
||||
void drawHollowBox(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
if (startx > endx) swapint(startx,endx);
|
||||
if (starty > endy) swapint(starty,endy);
|
||||
if (startz > endz) swapint(startz,endz);
|
||||
if (startx > endx) swapint(startx, endx);
|
||||
if (starty > endy) swapint(starty, endy);
|
||||
if (startz > endz) swapint(startz, endz);
|
||||
|
||||
|
||||
for (int i = startx; i <= endx; i ++) {
|
||||
for (int j = starty; j <= endy; j ++) {
|
||||
for (int k = startz; k <= endz; k ++) {
|
||||
if (i == startx || i == endx || j == starty || j == endy || k == startz || k == endz) {
|
||||
drawLed(color,brightness,i,j,k);
|
||||
drawLed(color, brightness, i, j, k);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
void drawHollowBox(int color, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
drawHollowBox(color,255,startx,starty,startz,endx,endy,endz);
|
||||
drawHollowBox(color, 255, startx, starty, startz, endx, endy, endz);
|
||||
}
|
||||
/****************************** DRAW BOX OUTLINE ******************************\
|
||||
| This function will draw edges of a defined box but none of the planes |
|
||||
\******************************************************************************/
|
||||
| This function will draw edges of a defined box but none of the planes |
|
||||
\******************************************************************************/
|
||||
void drawBoxOutline(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
if (startx > endx) swapint(startx,endx);
|
||||
if (starty > endy) swapint(starty,endy);
|
||||
if (startz > endz) swapint(startz,endz);
|
||||
if (startx > endx) swapint(startx, endx);
|
||||
if (starty > endy) swapint(starty, endy);
|
||||
if (startz > endz) swapint(startz, endz);
|
||||
|
||||
|
||||
for (int i = startx; i <= endx; i++) {
|
||||
for (int j = starty; j <= endy; j++) {
|
||||
for (int k = startz; k <= endz; k++) {
|
||||
int sum = (i == startx) + (i == endy) + (j == starty) + (j == endy) + (k == startz) + (k == endz);
|
||||
if (sum >= 2){
|
||||
drawLed(color,brightness,i,j,k);
|
||||
if (sum >= 2) {
|
||||
drawLed(color, brightness, i, j, k);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
void drawBoxOutline(int color, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
drawHollowBox(color,255,startx,starty,startz,endx,endy,endz);
|
||||
drawHollowBox(color, 255, startx, starty, startz, endx, endy, endz);
|
||||
}
|
||||
/******************************* DRAW BOX WALLS *******************************\
|
||||
| This function will draw the virtical walls and all four sides of a defined |
|
||||
| box |
|
||||
\******************************************************************************/
|
||||
| This function will draw the virtical walls and all four sides of a defined |
|
||||
| box |
|
||||
\******************************************************************************/
|
||||
void drawBoxWalls(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
if (startx > endx) swapint(startx,endx);
|
||||
if (starty > endy) swapint(starty,endy);
|
||||
if (startz > endz) swapint(startz,endz);
|
||||
if (startx > endx) swapint(startx, endx);
|
||||
if (starty > endy) swapint(starty, endy);
|
||||
if (startz > endz) swapint(startz, endz);
|
||||
|
||||
for (int i = startz; i <= endz; i++) {
|
||||
// draw y walls
|
||||
for (int j = starty; j <= endy; j++) {
|
||||
drawLed(color,brightness,startx,j,i);
|
||||
drawLed(color,brightness,endx,j,i);
|
||||
drawLed(color, brightness, startx, j, i);
|
||||
drawLed(color, brightness, endx, j, i);
|
||||
}
|
||||
// draw x walls
|
||||
for (int j = startx; j <= endx; j++) {
|
||||
drawLed(color,brightness,j,starty,i);
|
||||
drawLed(color,brightness,j,endy,i);
|
||||
drawLed(color, brightness, j, starty, i);
|
||||
drawLed(color, brightness, j, endy, i);
|
||||
}
|
||||
}
|
||||
}
|
||||
void drawBoxWalls(int color, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
drawBoxWalls(color,255,startx,starty,startz,endx,endy,endz);
|
||||
drawBoxWalls(color, 255, startx, starty, startz, endx, endy, endz);
|
||||
}
|
||||
/********************************** DRAW LINE *********************************\
|
||||
| This function will attempt to draw a line between the two points given. Due |
|
||||
| to the limited avalibility of pixels the best approximation is chosen for |
|
||||
| each pixel value |
|
||||
\******************************************************************************/
|
||||
| This function will attempt to draw a line between the two points given. Due |
|
||||
| to the limited avalibility of pixels the best approximation is chosen for |
|
||||
| each pixel value |
|
||||
\******************************************************************************/
|
||||
void drawLine(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
bool reverseX = false;
|
||||
bool reverseY = false;
|
||||
bool reverseZ = false;
|
||||
if (startx > endx) {swapint(startx,endx);reverseX=true;}
|
||||
if (starty > endy) {swapint(starty,endy);reverseY=true;}
|
||||
if (startz > endz) {swapint(startz,endz);reverseZ=true;}
|
||||
if (startx > endx) {
|
||||
swapint(startx, endx);
|
||||
reverseX = true;
|
||||
}
|
||||
if (starty > endy) {
|
||||
swapint(starty, endy);
|
||||
reverseY = true;
|
||||
}
|
||||
if (startz > endz) {
|
||||
swapint(startz, endz);
|
||||
reverseZ = true;
|
||||
}
|
||||
|
||||
int delx = endx - startx;
|
||||
int dely = endy - starty;
|
||||
int delz = endz - startz;
|
||||
|
||||
int longest = (delx>dely?delx>delz?delx:delz>dely?delz:dely:dely>delz?dely:delz>delx?delz:delx);
|
||||
int longest = (delx > dely ? delx > delz ? delx : delz > dely ? delz : dely : dely > delz ? dely : delz > delx ? delz : delx);
|
||||
for (int i = 0; i < longest; i++) {
|
||||
int xpos;
|
||||
if (reverseX) xpos = roundClostest(((longest-i)*delx),longest) + startx;
|
||||
else xpos = roundClostest((i*delx),longest) + startx;
|
||||
if (reverseX) xpos = roundClostest(((longest - i) * delx), longest) + startx;
|
||||
else xpos = roundClostest((i * delx), longest) + startx;
|
||||
|
||||
int ypos;
|
||||
if (reverseY) ypos = roundClostest(((longest-i)*dely),longest) + starty;
|
||||
else ypos = roundClostest((i*dely),longest) + starty;
|
||||
if (reverseY) ypos = roundClostest(((longest - i) * dely), longest) + starty;
|
||||
else ypos = roundClostest((i * dely), longest) + starty;
|
||||
|
||||
int zpos;
|
||||
if (reverseZ) zpos = roundClostest(((longest-i)*delz),longest) + startz;
|
||||
else zpos = roundClostest((i*delz),longest) + startz;
|
||||
if (reverseZ) zpos = roundClostest(((longest - i) * delz), longest) + startz;
|
||||
else zpos = roundClostest((i * delz), longest) + startz;
|
||||
|
||||
drawLed(color,brightness,xpos,ypos,zpos);
|
||||
drawLed(color, brightness, xpos, ypos, zpos);
|
||||
}
|
||||
|
||||
if (reverseX) swapint(startx,endx);
|
||||
if (reverseY) swapint(starty,endy);
|
||||
if (reverseZ) swapint(startz,endz);
|
||||
drawLed(color,brightness,endx,endy,endz);
|
||||
if (reverseX) swapint(startx, endx);
|
||||
if (reverseY) swapint(starty, endy);
|
||||
if (reverseZ) swapint(startz, endz);
|
||||
drawLed(color, brightness, endx, endy, endz);
|
||||
}
|
||||
void drawLine(int color, int startx, int starty, int startz, int endx, int endy, int endz) {
|
||||
drawLine(color,8,startx, starty, startz, endx, endy, endz);
|
||||
drawLine(color, 8, startx, starty, startz, endx, endy, endz);
|
||||
}
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
/////////////////////////////////// DISPLAY //////////////////////////////////
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
/////////////////////////////////// DISPLAY //////////////////////////////////
|
||||
//////////////////////////////////////////////////////////////////////////////
|
||||
int pwmm = 0;
|
||||
int display_length;
|
||||
void flushElement(_frame_light* ©_frame,int pin1,int pin2,int brightness) {
|
||||
void flushElement(_frame_light* ©_frame, int pin1, int pin2, int brightness) {
|
||||
pin1--;
|
||||
pin2--;
|
||||
|
||||
(copy_frame+1)->next=copy_frame;
|
||||
(copy_frame + 1)->next = copy_frame;
|
||||
copy_frame++;
|
||||
copy_frame->pin1=pin1 | ( brightness & 0xF0);
|
||||
copy_frame->pin2=pin2 | ((brightness & 0x0F) << 4);
|
||||
copy_frame->pin1 = pin1 | ( brightness & 0xF0);
|
||||
copy_frame->pin2 = pin2 | ((brightness & 0x0F) << 4);
|
||||
display_length++;
|
||||
}
|
||||
/******************************** FLUSH BUFFER ********************************\
|
||||
| This takes the buffer frame and sets the display memory to match, because |
|
||||
| the display memory needs to be faster it is split up into two arrays instead |
|
||||
| of just one. The display frame is actually a ciclic linked list which allows |
|
||||
| the program to just loop through and turn on the LEDs without the need to |
|
||||
| check to see if it is at the end of the loop |
|
||||
\******************************************************************************/
|
||||
| This takes the buffer frame and sets the display memory to match, because |
|
||||
| the display memory needs to be faster it is split up into two arrays instead |
|
||||
| of just one. The display frame is actually a ciclic linked list which allows |
|
||||
| the program to just loop through and turn on the LEDs without the need to |
|
||||
| check to see if it is at the end of the loop |
|
||||
\******************************************************************************/
|
||||
|
||||
void flushBuffer() {
|
||||
_frame_light * copy_frame = _cube__frame;
|
||||
|
|
@ -351,213 +366,213 @@ void flushBuffer() {
|
|||
|
||||
//TODO the pins values need to be changed so that the mapping.h file can
|
||||
// change them using #defines
|
||||
if (_cube_buffer[ 0] != 0)flushElement(copy_frame,13, 9,_cube_buffer[ 0]); // start blue
|
||||
if (_cube_buffer[ 1] != 0)flushElement(copy_frame, 9, 8,_cube_buffer[ 1]);
|
||||
if (_cube_buffer[ 2] != 0)flushElement(copy_frame, 8, 1,_cube_buffer[ 2]);
|
||||
if (_cube_buffer[ 3] != 0)flushElement(copy_frame, 1,13,_cube_buffer[ 3]);
|
||||
if (_cube_buffer[ 4] != 0)flushElement(copy_frame,14,10,_cube_buffer[ 4]);
|
||||
if (_cube_buffer[ 5] != 0)flushElement(copy_frame,10, 8,_cube_buffer[ 5]);
|
||||
if (_cube_buffer[ 6] != 0)flushElement(copy_frame, 8, 2,_cube_buffer[ 6]);
|
||||
if (_cube_buffer[ 7] != 0)flushElement(copy_frame, 2,14,_cube_buffer[ 7]);
|
||||
if (_cube_buffer[ 8] != 0)flushElement(copy_frame,15,11,_cube_buffer[ 8]);
|
||||
if (_cube_buffer[ 9] != 0)flushElement(copy_frame,11, 8,_cube_buffer[ 9]);
|
||||
if (_cube_buffer[ 10] != 0)flushElement(copy_frame, 8, 3,_cube_buffer[ 10]);
|
||||
if (_cube_buffer[ 11] != 0)flushElement(copy_frame, 3,15,_cube_buffer[ 11]);
|
||||
if (_cube_buffer[ 12] != 0)flushElement(copy_frame,16,12,_cube_buffer[ 12]);
|
||||
if (_cube_buffer[ 13] != 0)flushElement(copy_frame,12, 8,_cube_buffer[ 13]);
|
||||
if (_cube_buffer[ 14] != 0)flushElement(copy_frame, 8, 4,_cube_buffer[ 14]);
|
||||
if (_cube_buffer[ 15] != 0)flushElement(copy_frame, 4,16,_cube_buffer[ 15]);
|
||||
if (_cube_buffer[ 16] != 0)flushElement(copy_frame,16,10,_cube_buffer[ 16]);
|
||||
if (_cube_buffer[ 17] != 0)flushElement(copy_frame,10, 7,_cube_buffer[ 17]);
|
||||
if (_cube_buffer[ 18] != 0)flushElement(copy_frame, 7, 1,_cube_buffer[ 18]);
|
||||
if (_cube_buffer[ 19] != 0)flushElement(copy_frame, 1,16,_cube_buffer[ 19]);
|
||||
if (_cube_buffer[ 20] != 0)flushElement(copy_frame,15, 9,_cube_buffer[ 20]);
|
||||
if (_cube_buffer[ 21] != 0)flushElement(copy_frame, 9, 7,_cube_buffer[ 21]);
|
||||
if (_cube_buffer[ 22] != 0)flushElement(copy_frame, 7, 2,_cube_buffer[ 22]);
|
||||
if (_cube_buffer[ 23] != 0)flushElement(copy_frame, 2,15,_cube_buffer[ 23]);
|
||||
if (_cube_buffer[ 24] != 0)flushElement(copy_frame,14,12,_cube_buffer[ 24]);
|
||||
if (_cube_buffer[ 25] != 0)flushElement(copy_frame,12, 7,_cube_buffer[ 25]);
|
||||
if (_cube_buffer[ 26] != 0)flushElement(copy_frame, 7, 3,_cube_buffer[ 26]);
|
||||
if (_cube_buffer[ 27] != 0)flushElement(copy_frame, 3,14,_cube_buffer[ 27]);
|
||||
if (_cube_buffer[ 28] != 0)flushElement(copy_frame,13,11,_cube_buffer[ 28]);
|
||||
if (_cube_buffer[ 29] != 0)flushElement(copy_frame,11, 7,_cube_buffer[ 29]);
|
||||
if (_cube_buffer[ 30] != 0)flushElement(copy_frame, 7, 4,_cube_buffer[ 30]);
|
||||
if (_cube_buffer[ 31] != 0)flushElement(copy_frame, 4,13,_cube_buffer[ 31]);
|
||||
if (_cube_buffer[ 32] != 0)flushElement(copy_frame, 1,14,_cube_buffer[ 32]);
|
||||
if (_cube_buffer[ 33] != 0)flushElement(copy_frame,14,11,_cube_buffer[ 33]);
|
||||
if (_cube_buffer[ 34] != 0)flushElement(copy_frame,11, 6,_cube_buffer[ 34]);
|
||||
if (_cube_buffer[ 35] != 0)flushElement(copy_frame, 6, 1,_cube_buffer[ 35]);
|
||||
if (_cube_buffer[ 36] != 0)flushElement(copy_frame,13,12,_cube_buffer[ 36]);
|
||||
if (_cube_buffer[ 37] != 0)flushElement(copy_frame,12, 6,_cube_buffer[ 37]);
|
||||
if (_cube_buffer[ 38] != 0)flushElement(copy_frame, 6, 2,_cube_buffer[ 38]);
|
||||
if (_cube_buffer[ 39] != 0)flushElement(copy_frame, 2,13,_cube_buffer[ 39]);
|
||||
if (_cube_buffer[ 40] != 0)flushElement(copy_frame,16, 9,_cube_buffer[ 40]);
|
||||
if (_cube_buffer[ 41] != 0)flushElement(copy_frame, 9, 6,_cube_buffer[ 41]);
|
||||
if (_cube_buffer[ 42] != 0)flushElement(copy_frame, 6, 3,_cube_buffer[ 42]);
|
||||
if (_cube_buffer[ 43] != 0)flushElement(copy_frame, 3,16,_cube_buffer[ 43]);
|
||||
if (_cube_buffer[ 44] != 0)flushElement(copy_frame,15,10,_cube_buffer[ 44]);
|
||||
if (_cube_buffer[ 45] != 0)flushElement(copy_frame,10, 6,_cube_buffer[ 45]);
|
||||
if (_cube_buffer[ 46] != 0)flushElement(copy_frame, 6, 4,_cube_buffer[ 46]);
|
||||
if (_cube_buffer[ 47] != 0)flushElement(copy_frame, 4,15,_cube_buffer[ 47]);
|
||||
if (_cube_buffer[ 48] != 0)flushElement(copy_frame,15,12,_cube_buffer[ 48]);
|
||||
if (_cube_buffer[ 49] != 0)flushElement(copy_frame,12, 5,_cube_buffer[ 49]);
|
||||
if (_cube_buffer[ 50] != 0)flushElement(copy_frame, 5, 1,_cube_buffer[ 50]);
|
||||
if (_cube_buffer[ 51] != 0)flushElement(copy_frame, 1,15,_cube_buffer[ 51]);
|
||||
if (_cube_buffer[ 52] != 0)flushElement(copy_frame,16,11,_cube_buffer[ 52]);
|
||||
if (_cube_buffer[ 53] != 0)flushElement(copy_frame,11, 5,_cube_buffer[ 53]);
|
||||
if (_cube_buffer[ 54] != 0)flushElement(copy_frame, 5, 2,_cube_buffer[ 54]);
|
||||
if (_cube_buffer[ 55] != 0)flushElement(copy_frame, 2,16,_cube_buffer[ 55]);
|
||||
if (_cube_buffer[ 56] != 0)flushElement(copy_frame,13,10,_cube_buffer[ 56]);
|
||||
if (_cube_buffer[ 57] != 0)flushElement(copy_frame,10, 5,_cube_buffer[ 57]);
|
||||
if (_cube_buffer[ 58] != 0)flushElement(copy_frame, 5, 3,_cube_buffer[ 58]);
|
||||
if (_cube_buffer[ 59] != 0)flushElement(copy_frame, 3,13,_cube_buffer[ 59]);
|
||||
if (_cube_buffer[ 60] != 0)flushElement(copy_frame,14, 9,_cube_buffer[ 60]);
|
||||
if (_cube_buffer[ 61] != 0)flushElement(copy_frame, 9, 5,_cube_buffer[ 61]);
|
||||
if (_cube_buffer[ 62] != 0)flushElement(copy_frame, 5, 4,_cube_buffer[ 62]);
|
||||
if (_cube_buffer[ 63] != 0)flushElement(copy_frame, 4,14,_cube_buffer[ 63]); // end blue
|
||||
if (_cube_buffer[ 64] != 0)flushElement(copy_frame, 1, 9,_cube_buffer[ 64]); // start green
|
||||
if (_cube_buffer[ 65] != 0)flushElement(copy_frame,13, 8,_cube_buffer[ 65]);
|
||||
if (_cube_buffer[ 66] != 0)flushElement(copy_frame, 9, 1,_cube_buffer[ 66]);
|
||||
if (_cube_buffer[ 67] != 0)flushElement(copy_frame, 8,13,_cube_buffer[ 67]);
|
||||
if (_cube_buffer[ 68] != 0)flushElement(copy_frame, 2,10,_cube_buffer[ 68]);
|
||||
if (_cube_buffer[ 69] != 0)flushElement(copy_frame,14, 8,_cube_buffer[ 69]);
|
||||
if (_cube_buffer[ 70] != 0)flushElement(copy_frame,10, 2,_cube_buffer[ 70]);
|
||||
if (_cube_buffer[ 71] != 0)flushElement(copy_frame, 8,14,_cube_buffer[ 71]);
|
||||
if (_cube_buffer[ 72] != 0)flushElement(copy_frame, 3,11,_cube_buffer[ 72]);
|
||||
if (_cube_buffer[ 73] != 0)flushElement(copy_frame,15, 8,_cube_buffer[ 73]);
|
||||
if (_cube_buffer[ 74] != 0)flushElement(copy_frame,11, 3,_cube_buffer[ 74]);
|
||||
if (_cube_buffer[ 75] != 0)flushElement(copy_frame, 8,15,_cube_buffer[ 75]);
|
||||
if (_cube_buffer[ 76] != 0)flushElement(copy_frame, 4,12,_cube_buffer[ 76]);
|
||||
if (_cube_buffer[ 77] != 0)flushElement(copy_frame,16, 8,_cube_buffer[ 77]);
|
||||
if (_cube_buffer[ 78] != 0)flushElement(copy_frame,12, 4,_cube_buffer[ 78]);
|
||||
if (_cube_buffer[ 79] != 0)flushElement(copy_frame, 8,16,_cube_buffer[ 79]);
|
||||
if (_cube_buffer[ 80] != 0)flushElement(copy_frame, 1,10,_cube_buffer[ 80]);
|
||||
if (_cube_buffer[ 81] != 0)flushElement(copy_frame,16, 7,_cube_buffer[ 81]);
|
||||
if (_cube_buffer[ 82] != 0)flushElement(copy_frame,10, 1,_cube_buffer[ 82]);
|
||||
if (_cube_buffer[ 83] != 0)flushElement(copy_frame, 7,16,_cube_buffer[ 83]);
|
||||
if (_cube_buffer[ 84] != 0)flushElement(copy_frame, 2, 9,_cube_buffer[ 84]);
|
||||
if (_cube_buffer[ 85] != 0)flushElement(copy_frame,15, 7,_cube_buffer[ 85]);
|
||||
if (_cube_buffer[ 86] != 0)flushElement(copy_frame, 9, 2,_cube_buffer[ 86]);
|
||||
if (_cube_buffer[ 87] != 0)flushElement(copy_frame, 7,15,_cube_buffer[ 87]);
|
||||
if (_cube_buffer[ 88] != 0)flushElement(copy_frame, 3,12,_cube_buffer[ 88]);
|
||||
if (_cube_buffer[ 89] != 0)flushElement(copy_frame,14, 7,_cube_buffer[ 89]);
|
||||
if (_cube_buffer[ 90] != 0)flushElement(copy_frame,12, 3,_cube_buffer[ 90]);
|
||||
if (_cube_buffer[ 91] != 0)flushElement(copy_frame, 7,14,_cube_buffer[ 91]);
|
||||
if (_cube_buffer[ 92] != 0)flushElement(copy_frame, 4,11,_cube_buffer[ 92]);
|
||||
if (_cube_buffer[ 93] != 0)flushElement(copy_frame,13, 7,_cube_buffer[ 93]);
|
||||
if (_cube_buffer[ 94] != 0)flushElement(copy_frame,11, 4,_cube_buffer[ 94]);
|
||||
if (_cube_buffer[ 95] != 0)flushElement(copy_frame, 7,13,_cube_buffer[ 95]);
|
||||
if (_cube_buffer[ 96] != 0)flushElement(copy_frame, 6,14,_cube_buffer[ 96]);
|
||||
if (_cube_buffer[ 97] != 0)flushElement(copy_frame, 1,11,_cube_buffer[ 97]);
|
||||
if (_cube_buffer[ 98] != 0)flushElement(copy_frame,14, 6,_cube_buffer[ 98]);
|
||||
if (_cube_buffer[ 99] != 0)flushElement(copy_frame,11, 1,_cube_buffer[ 99]);
|
||||
if (_cube_buffer[100] != 0)flushElement(copy_frame, 2,12,_cube_buffer[100]);
|
||||
if (_cube_buffer[101] != 0)flushElement(copy_frame,13, 6,_cube_buffer[101]);
|
||||
if (_cube_buffer[102] != 0)flushElement(copy_frame,12, 2,_cube_buffer[102]);
|
||||
if (_cube_buffer[103] != 0)flushElement(copy_frame, 6,13,_cube_buffer[103]);
|
||||
if (_cube_buffer[104] != 0)flushElement(copy_frame, 3, 9,_cube_buffer[104]);
|
||||
if (_cube_buffer[105] != 0)flushElement(copy_frame,16, 6,_cube_buffer[105]);
|
||||
if (_cube_buffer[106] != 0)flushElement(copy_frame, 9, 3,_cube_buffer[106]);
|
||||
if (_cube_buffer[107] != 0)flushElement(copy_frame, 6,16,_cube_buffer[107]);
|
||||
if (_cube_buffer[108] != 0)flushElement(copy_frame, 4,10,_cube_buffer[108]);
|
||||
if (_cube_buffer[109] != 0)flushElement(copy_frame,15, 6,_cube_buffer[109]);
|
||||
if (_cube_buffer[110] != 0)flushElement(copy_frame,10, 4,_cube_buffer[110]);
|
||||
if (_cube_buffer[111] != 0)flushElement(copy_frame, 6,15,_cube_buffer[111]);
|
||||
if (_cube_buffer[112] != 0)flushElement(copy_frame, 1,12,_cube_buffer[112]);
|
||||
if (_cube_buffer[113] != 0)flushElement(copy_frame,15, 5,_cube_buffer[113]);
|
||||
if (_cube_buffer[114] != 0)flushElement(copy_frame,12, 1,_cube_buffer[114]);
|
||||
if (_cube_buffer[115] != 0)flushElement(copy_frame, 5,15,_cube_buffer[115]);
|
||||
if (_cube_buffer[116] != 0)flushElement(copy_frame, 2,11,_cube_buffer[116]);
|
||||
if (_cube_buffer[117] != 0)flushElement(copy_frame,16, 5,_cube_buffer[117]);
|
||||
if (_cube_buffer[118] != 0)flushElement(copy_frame,11, 2,_cube_buffer[118]);
|
||||
if (_cube_buffer[119] != 0)flushElement(copy_frame, 5,16,_cube_buffer[119]);
|
||||
if (_cube_buffer[120] != 0)flushElement(copy_frame, 3,10,_cube_buffer[120]);
|
||||
if (_cube_buffer[121] != 0)flushElement(copy_frame,13, 5,_cube_buffer[121]);
|
||||
if (_cube_buffer[122] != 0)flushElement(copy_frame,10, 3,_cube_buffer[122]);
|
||||
if (_cube_buffer[123] != 0)flushElement(copy_frame, 5,13,_cube_buffer[123]);
|
||||
if (_cube_buffer[124] != 0)flushElement(copy_frame, 4, 9,_cube_buffer[124]);
|
||||
if (_cube_buffer[125] != 0)flushElement(copy_frame,14, 5,_cube_buffer[125]);
|
||||
if (_cube_buffer[126] != 0)flushElement(copy_frame, 9, 4,_cube_buffer[126]);
|
||||
if (_cube_buffer[127] != 0)flushElement(copy_frame, 5,14,_cube_buffer[127]); // end green
|
||||
if (_cube_buffer[128] != 0)flushElement(copy_frame, 8, 9,_cube_buffer[128]); // start red
|
||||
if (_cube_buffer[129] != 0)flushElement(copy_frame, 1, 8,_cube_buffer[129]);
|
||||
if (_cube_buffer[130] != 0)flushElement(copy_frame,13, 1,_cube_buffer[130]);
|
||||
if (_cube_buffer[131] != 0)flushElement(copy_frame, 9,13,_cube_buffer[131]);
|
||||
if (_cube_buffer[132] != 0)flushElement(copy_frame, 8,10,_cube_buffer[132]);
|
||||
if (_cube_buffer[133] != 0)flushElement(copy_frame, 2, 8,_cube_buffer[133]);
|
||||
if (_cube_buffer[134] != 0)flushElement(copy_frame,14, 2,_cube_buffer[134]);
|
||||
if (_cube_buffer[135] != 0)flushElement(copy_frame,10,14,_cube_buffer[135]);
|
||||
if (_cube_buffer[136] != 0)flushElement(copy_frame, 8,11,_cube_buffer[136]);
|
||||
if (_cube_buffer[137] != 0)flushElement(copy_frame, 3, 8,_cube_buffer[137]);
|
||||
if (_cube_buffer[138] != 0)flushElement(copy_frame,15, 3,_cube_buffer[138]);
|
||||
if (_cube_buffer[139] != 0)flushElement(copy_frame,11,15,_cube_buffer[139]);
|
||||
if (_cube_buffer[140] != 0)flushElement(copy_frame, 8,12,_cube_buffer[140]);
|
||||
if (_cube_buffer[141] != 0)flushElement(copy_frame, 4, 8,_cube_buffer[141]);
|
||||
if (_cube_buffer[142] != 0)flushElement(copy_frame,16, 4,_cube_buffer[142]);
|
||||
if (_cube_buffer[143] != 0)flushElement(copy_frame,12,16,_cube_buffer[143]);
|
||||
if (_cube_buffer[144] != 0)flushElement(copy_frame, 7,10,_cube_buffer[144]);
|
||||
if (_cube_buffer[145] != 0)flushElement(copy_frame, 1, 7,_cube_buffer[145]);
|
||||
if (_cube_buffer[146] != 0)flushElement(copy_frame,16, 1,_cube_buffer[146]);
|
||||
if (_cube_buffer[147] != 0)flushElement(copy_frame,10,16,_cube_buffer[147]);
|
||||
if (_cube_buffer[148] != 0)flushElement(copy_frame, 7, 9,_cube_buffer[148]);
|
||||
if (_cube_buffer[149] != 0)flushElement(copy_frame, 2, 7,_cube_buffer[149]);
|
||||
if (_cube_buffer[150] != 0)flushElement(copy_frame,15, 2,_cube_buffer[150]);
|
||||
if (_cube_buffer[151] != 0)flushElement(copy_frame, 9,15,_cube_buffer[151]);
|
||||
if (_cube_buffer[152] != 0)flushElement(copy_frame, 7,12,_cube_buffer[152]);
|
||||
if (_cube_buffer[153] != 0)flushElement(copy_frame, 3, 7,_cube_buffer[153]);
|
||||
if (_cube_buffer[154] != 0)flushElement(copy_frame,14, 3,_cube_buffer[154]);
|
||||
if (_cube_buffer[155] != 0)flushElement(copy_frame,12,14,_cube_buffer[155]);
|
||||
if (_cube_buffer[156] != 0)flushElement(copy_frame, 7,11,_cube_buffer[156]);
|
||||
if (_cube_buffer[157] != 0)flushElement(copy_frame, 4, 7,_cube_buffer[157]);
|
||||
if (_cube_buffer[158] != 0)flushElement(copy_frame,13, 4,_cube_buffer[158]);
|
||||
if (_cube_buffer[159] != 0)flushElement(copy_frame,11,13,_cube_buffer[159]);
|
||||
if (_cube_buffer[160] != 0)flushElement(copy_frame,11,14,_cube_buffer[160]);
|
||||
if (_cube_buffer[161] != 0)flushElement(copy_frame, 6,11,_cube_buffer[161]);
|
||||
if (_cube_buffer[162] != 0)flushElement(copy_frame, 1, 6,_cube_buffer[162]);
|
||||
if (_cube_buffer[163] != 0)flushElement(copy_frame,14, 1,_cube_buffer[163]);
|
||||
if (_cube_buffer[164] != 0)flushElement(copy_frame, 6,12,_cube_buffer[164]);
|
||||
if (_cube_buffer[165] != 0)flushElement(copy_frame, 2, 6,_cube_buffer[165]);
|
||||
if (_cube_buffer[166] != 0)flushElement(copy_frame,13, 2,_cube_buffer[166]);
|
||||
if (_cube_buffer[167] != 0)flushElement(copy_frame,12,13,_cube_buffer[167]);
|
||||
if (_cube_buffer[168] != 0)flushElement(copy_frame, 6, 9,_cube_buffer[168]);
|
||||
if (_cube_buffer[169] != 0)flushElement(copy_frame, 3, 6,_cube_buffer[169]);
|
||||
if (_cube_buffer[170] != 0)flushElement(copy_frame,16, 3,_cube_buffer[170]);
|
||||
if (_cube_buffer[171] != 0)flushElement(copy_frame, 9,16,_cube_buffer[171]);
|
||||
if (_cube_buffer[172] != 0)flushElement(copy_frame, 6,10,_cube_buffer[172]);
|
||||
if (_cube_buffer[173] != 0)flushElement(copy_frame, 4, 6,_cube_buffer[173]);
|
||||
if (_cube_buffer[174] != 0)flushElement(copy_frame,15, 4,_cube_buffer[174]);
|
||||
if (_cube_buffer[175] != 0)flushElement(copy_frame,10,15,_cube_buffer[175]);
|
||||
if (_cube_buffer[176] != 0)flushElement(copy_frame, 5,12,_cube_buffer[176]);
|
||||
if (_cube_buffer[177] != 0)flushElement(copy_frame, 1, 5,_cube_buffer[177]);
|
||||
if (_cube_buffer[178] != 0)flushElement(copy_frame,15, 1,_cube_buffer[178]);
|
||||
if (_cube_buffer[179] != 0)flushElement(copy_frame,12,15,_cube_buffer[179]);
|
||||
if (_cube_buffer[180] != 0)flushElement(copy_frame, 5,11,_cube_buffer[180]);
|
||||
if (_cube_buffer[181] != 0)flushElement(copy_frame, 2, 5,_cube_buffer[181]);
|
||||
if (_cube_buffer[182] != 0)flushElement(copy_frame,16, 2,_cube_buffer[182]);
|
||||
if (_cube_buffer[183] != 0)flushElement(copy_frame,11,16,_cube_buffer[183]);
|
||||
if (_cube_buffer[184] != 0)flushElement(copy_frame, 5,10,_cube_buffer[184]);
|
||||
if (_cube_buffer[185] != 0)flushElement(copy_frame, 3, 5,_cube_buffer[185]);
|
||||
if (_cube_buffer[186] != 0)flushElement(copy_frame,13, 3,_cube_buffer[186]);
|
||||
if (_cube_buffer[187] != 0)flushElement(copy_frame,10,13,_cube_buffer[187]);
|
||||
if (_cube_buffer[188] != 0)flushElement(copy_frame, 5, 9,_cube_buffer[188]);
|
||||
if (_cube_buffer[189] != 0)flushElement(copy_frame, 4, 5,_cube_buffer[189]);
|
||||
if (_cube_buffer[190] != 0)flushElement(copy_frame,14, 4,_cube_buffer[190]);
|
||||
if (_cube_buffer[191] != 0)flushElement(copy_frame, 9,14,_cube_buffer[191]); // end red
|
||||
if (_cube_buffer[ 0] != 0)flushElement(copy_frame, 13, 9, _cube_buffer[ 0]); // start blue
|
||||
if (_cube_buffer[ 1] != 0)flushElement(copy_frame, 9, 8, _cube_buffer[ 1]);
|
||||
if (_cube_buffer[ 2] != 0)flushElement(copy_frame, 8, 1, _cube_buffer[ 2]);
|
||||
if (_cube_buffer[ 3] != 0)flushElement(copy_frame, 1, 13, _cube_buffer[ 3]);
|
||||
if (_cube_buffer[ 4] != 0)flushElement(copy_frame, 14, 10, _cube_buffer[ 4]);
|
||||
if (_cube_buffer[ 5] != 0)flushElement(copy_frame, 10, 8, _cube_buffer[ 5]);
|
||||
if (_cube_buffer[ 6] != 0)flushElement(copy_frame, 8, 2, _cube_buffer[ 6]);
|
||||
if (_cube_buffer[ 7] != 0)flushElement(copy_frame, 2, 14, _cube_buffer[ 7]);
|
||||
if (_cube_buffer[ 8] != 0)flushElement(copy_frame, 15, 11, _cube_buffer[ 8]);
|
||||
if (_cube_buffer[ 9] != 0)flushElement(copy_frame, 11, 8, _cube_buffer[ 9]);
|
||||
if (_cube_buffer[ 10] != 0)flushElement(copy_frame, 8, 3, _cube_buffer[ 10]);
|
||||
if (_cube_buffer[ 11] != 0)flushElement(copy_frame, 3, 15, _cube_buffer[ 11]);
|
||||
if (_cube_buffer[ 12] != 0)flushElement(copy_frame, 16, 12, _cube_buffer[ 12]);
|
||||
if (_cube_buffer[ 13] != 0)flushElement(copy_frame, 12, 8, _cube_buffer[ 13]);
|
||||
if (_cube_buffer[ 14] != 0)flushElement(copy_frame, 8, 4, _cube_buffer[ 14]);
|
||||
if (_cube_buffer[ 15] != 0)flushElement(copy_frame, 4, 16, _cube_buffer[ 15]);
|
||||
if (_cube_buffer[ 16] != 0)flushElement(copy_frame, 16, 10, _cube_buffer[ 16]);
|
||||
if (_cube_buffer[ 17] != 0)flushElement(copy_frame, 10, 7, _cube_buffer[ 17]);
|
||||
if (_cube_buffer[ 18] != 0)flushElement(copy_frame, 7, 1, _cube_buffer[ 18]);
|
||||
if (_cube_buffer[ 19] != 0)flushElement(copy_frame, 1, 16, _cube_buffer[ 19]);
|
||||
if (_cube_buffer[ 20] != 0)flushElement(copy_frame, 15, 9, _cube_buffer[ 20]);
|
||||
if (_cube_buffer[ 21] != 0)flushElement(copy_frame, 9, 7, _cube_buffer[ 21]);
|
||||
if (_cube_buffer[ 22] != 0)flushElement(copy_frame, 7, 2, _cube_buffer[ 22]);
|
||||
if (_cube_buffer[ 23] != 0)flushElement(copy_frame, 2, 15, _cube_buffer[ 23]);
|
||||
if (_cube_buffer[ 24] != 0)flushElement(copy_frame, 14, 12, _cube_buffer[ 24]);
|
||||
if (_cube_buffer[ 25] != 0)flushElement(copy_frame, 12, 7, _cube_buffer[ 25]);
|
||||
if (_cube_buffer[ 26] != 0)flushElement(copy_frame, 7, 3, _cube_buffer[ 26]);
|
||||
if (_cube_buffer[ 27] != 0)flushElement(copy_frame, 3, 14, _cube_buffer[ 27]);
|
||||
if (_cube_buffer[ 28] != 0)flushElement(copy_frame, 13, 11, _cube_buffer[ 28]);
|
||||
if (_cube_buffer[ 29] != 0)flushElement(copy_frame, 11, 7, _cube_buffer[ 29]);
|
||||
if (_cube_buffer[ 30] != 0)flushElement(copy_frame, 7, 4, _cube_buffer[ 30]);
|
||||
if (_cube_buffer[ 31] != 0)flushElement(copy_frame, 4, 13, _cube_buffer[ 31]);
|
||||
if (_cube_buffer[ 32] != 0)flushElement(copy_frame, 1, 14, _cube_buffer[ 32]);
|
||||
if (_cube_buffer[ 33] != 0)flushElement(copy_frame, 14, 11, _cube_buffer[ 33]);
|
||||
if (_cube_buffer[ 34] != 0)flushElement(copy_frame, 11, 6, _cube_buffer[ 34]);
|
||||
if (_cube_buffer[ 35] != 0)flushElement(copy_frame, 6, 1, _cube_buffer[ 35]);
|
||||
if (_cube_buffer[ 36] != 0)flushElement(copy_frame, 13, 12, _cube_buffer[ 36]);
|
||||
if (_cube_buffer[ 37] != 0)flushElement(copy_frame, 12, 6, _cube_buffer[ 37]);
|
||||
if (_cube_buffer[ 38] != 0)flushElement(copy_frame, 6, 2, _cube_buffer[ 38]);
|
||||
if (_cube_buffer[ 39] != 0)flushElement(copy_frame, 2, 13, _cube_buffer[ 39]);
|
||||
if (_cube_buffer[ 40] != 0)flushElement(copy_frame, 16, 9, _cube_buffer[ 40]);
|
||||
if (_cube_buffer[ 41] != 0)flushElement(copy_frame, 9, 6, _cube_buffer[ 41]);
|
||||
if (_cube_buffer[ 42] != 0)flushElement(copy_frame, 6, 3, _cube_buffer[ 42]);
|
||||
if (_cube_buffer[ 43] != 0)flushElement(copy_frame, 3, 16, _cube_buffer[ 43]);
|
||||
if (_cube_buffer[ 44] != 0)flushElement(copy_frame, 15, 10, _cube_buffer[ 44]);
|
||||
if (_cube_buffer[ 45] != 0)flushElement(copy_frame, 10, 6, _cube_buffer[ 45]);
|
||||
if (_cube_buffer[ 46] != 0)flushElement(copy_frame, 6, 4, _cube_buffer[ 46]);
|
||||
if (_cube_buffer[ 47] != 0)flushElement(copy_frame, 4, 15, _cube_buffer[ 47]);
|
||||
if (_cube_buffer[ 48] != 0)flushElement(copy_frame, 15, 12, _cube_buffer[ 48]);
|
||||
if (_cube_buffer[ 49] != 0)flushElement(copy_frame, 12, 5, _cube_buffer[ 49]);
|
||||
if (_cube_buffer[ 50] != 0)flushElement(copy_frame, 5, 1, _cube_buffer[ 50]);
|
||||
if (_cube_buffer[ 51] != 0)flushElement(copy_frame, 1, 15, _cube_buffer[ 51]);
|
||||
if (_cube_buffer[ 52] != 0)flushElement(copy_frame, 16, 11, _cube_buffer[ 52]);
|
||||
if (_cube_buffer[ 53] != 0)flushElement(copy_frame, 11, 5, _cube_buffer[ 53]);
|
||||
if (_cube_buffer[ 54] != 0)flushElement(copy_frame, 5, 2, _cube_buffer[ 54]);
|
||||
if (_cube_buffer[ 55] != 0)flushElement(copy_frame, 2, 16, _cube_buffer[ 55]);
|
||||
if (_cube_buffer[ 56] != 0)flushElement(copy_frame, 13, 10, _cube_buffer[ 56]);
|
||||
if (_cube_buffer[ 57] != 0)flushElement(copy_frame, 10, 5, _cube_buffer[ 57]);
|
||||
if (_cube_buffer[ 58] != 0)flushElement(copy_frame, 5, 3, _cube_buffer[ 58]);
|
||||
if (_cube_buffer[ 59] != 0)flushElement(copy_frame, 3, 13, _cube_buffer[ 59]);
|
||||
if (_cube_buffer[ 60] != 0)flushElement(copy_frame, 14, 9, _cube_buffer[ 60]);
|
||||
if (_cube_buffer[ 61] != 0)flushElement(copy_frame, 9, 5, _cube_buffer[ 61]);
|
||||
if (_cube_buffer[ 62] != 0)flushElement(copy_frame, 5, 4, _cube_buffer[ 62]);
|
||||
if (_cube_buffer[ 63] != 0)flushElement(copy_frame, 4, 14, _cube_buffer[ 63]); // end blue
|
||||
if (_cube_buffer[ 64] != 0)flushElement(copy_frame, 1, 9, _cube_buffer[ 64]); // start green
|
||||
if (_cube_buffer[ 65] != 0)flushElement(copy_frame, 13, 8, _cube_buffer[ 65]);
|
||||
if (_cube_buffer[ 66] != 0)flushElement(copy_frame, 9, 1, _cube_buffer[ 66]);
|
||||
if (_cube_buffer[ 67] != 0)flushElement(copy_frame, 8, 13, _cube_buffer[ 67]);
|
||||
if (_cube_buffer[ 68] != 0)flushElement(copy_frame, 2, 10, _cube_buffer[ 68]);
|
||||
if (_cube_buffer[ 69] != 0)flushElement(copy_frame, 14, 8, _cube_buffer[ 69]);
|
||||
if (_cube_buffer[ 70] != 0)flushElement(copy_frame, 10, 2, _cube_buffer[ 70]);
|
||||
if (_cube_buffer[ 71] != 0)flushElement(copy_frame, 8, 14, _cube_buffer[ 71]);
|
||||
if (_cube_buffer[ 72] != 0)flushElement(copy_frame, 3, 11, _cube_buffer[ 72]);
|
||||
if (_cube_buffer[ 73] != 0)flushElement(copy_frame, 15, 8, _cube_buffer[ 73]);
|
||||
if (_cube_buffer[ 74] != 0)flushElement(copy_frame, 11, 3, _cube_buffer[ 74]);
|
||||
if (_cube_buffer[ 75] != 0)flushElement(copy_frame, 8, 15, _cube_buffer[ 75]);
|
||||
if (_cube_buffer[ 76] != 0)flushElement(copy_frame, 4, 12, _cube_buffer[ 76]);
|
||||
if (_cube_buffer[ 77] != 0)flushElement(copy_frame, 16, 8, _cube_buffer[ 77]);
|
||||
if (_cube_buffer[ 78] != 0)flushElement(copy_frame, 12, 4, _cube_buffer[ 78]);
|
||||
if (_cube_buffer[ 79] != 0)flushElement(copy_frame, 8, 16, _cube_buffer[ 79]);
|
||||
if (_cube_buffer[ 80] != 0)flushElement(copy_frame, 1, 10, _cube_buffer[ 80]);
|
||||
if (_cube_buffer[ 81] != 0)flushElement(copy_frame, 16, 7, _cube_buffer[ 81]);
|
||||
if (_cube_buffer[ 82] != 0)flushElement(copy_frame, 10, 1, _cube_buffer[ 82]);
|
||||
if (_cube_buffer[ 83] != 0)flushElement(copy_frame, 7, 16, _cube_buffer[ 83]);
|
||||
if (_cube_buffer[ 84] != 0)flushElement(copy_frame, 2, 9, _cube_buffer[ 84]);
|
||||
if (_cube_buffer[ 85] != 0)flushElement(copy_frame, 15, 7, _cube_buffer[ 85]);
|
||||
if (_cube_buffer[ 86] != 0)flushElement(copy_frame, 9, 2, _cube_buffer[ 86]);
|
||||
if (_cube_buffer[ 87] != 0)flushElement(copy_frame, 7, 15, _cube_buffer[ 87]);
|
||||
if (_cube_buffer[ 88] != 0)flushElement(copy_frame, 3, 12, _cube_buffer[ 88]);
|
||||
if (_cube_buffer[ 89] != 0)flushElement(copy_frame, 14, 7, _cube_buffer[ 89]);
|
||||
if (_cube_buffer[ 90] != 0)flushElement(copy_frame, 12, 3, _cube_buffer[ 90]);
|
||||
if (_cube_buffer[ 91] != 0)flushElement(copy_frame, 7, 14, _cube_buffer[ 91]);
|
||||
if (_cube_buffer[ 92] != 0)flushElement(copy_frame, 4, 11, _cube_buffer[ 92]);
|
||||
if (_cube_buffer[ 93] != 0)flushElement(copy_frame, 13, 7, _cube_buffer[ 93]);
|
||||
if (_cube_buffer[ 94] != 0)flushElement(copy_frame, 11, 4, _cube_buffer[ 94]);
|
||||
if (_cube_buffer[ 95] != 0)flushElement(copy_frame, 7, 13, _cube_buffer[ 95]);
|
||||
if (_cube_buffer[ 96] != 0)flushElement(copy_frame, 6, 14, _cube_buffer[ 96]);
|
||||
if (_cube_buffer[ 97] != 0)flushElement(copy_frame, 1, 11, _cube_buffer[ 97]);
|
||||
if (_cube_buffer[ 98] != 0)flushElement(copy_frame, 14, 6, _cube_buffer[ 98]);
|
||||
if (_cube_buffer[ 99] != 0)flushElement(copy_frame, 11, 1, _cube_buffer[ 99]);
|
||||
if (_cube_buffer[100] != 0)flushElement(copy_frame, 2, 12, _cube_buffer[100]);
|
||||
if (_cube_buffer[101] != 0)flushElement(copy_frame, 13, 6, _cube_buffer[101]);
|
||||
if (_cube_buffer[102] != 0)flushElement(copy_frame, 12, 2, _cube_buffer[102]);
|
||||
if (_cube_buffer[103] != 0)flushElement(copy_frame, 6, 13, _cube_buffer[103]);
|
||||
if (_cube_buffer[104] != 0)flushElement(copy_frame, 3, 9, _cube_buffer[104]);
|
||||
if (_cube_buffer[105] != 0)flushElement(copy_frame, 16, 6, _cube_buffer[105]);
|
||||
if (_cube_buffer[106] != 0)flushElement(copy_frame, 9, 3, _cube_buffer[106]);
|
||||
if (_cube_buffer[107] != 0)flushElement(copy_frame, 6, 16, _cube_buffer[107]);
|
||||
if (_cube_buffer[108] != 0)flushElement(copy_frame, 4, 10, _cube_buffer[108]);
|
||||
if (_cube_buffer[109] != 0)flushElement(copy_frame, 15, 6, _cube_buffer[109]);
|
||||
if (_cube_buffer[110] != 0)flushElement(copy_frame, 10, 4, _cube_buffer[110]);
|
||||
if (_cube_buffer[111] != 0)flushElement(copy_frame, 6, 15, _cube_buffer[111]);
|
||||
if (_cube_buffer[112] != 0)flushElement(copy_frame, 1, 12, _cube_buffer[112]);
|
||||
if (_cube_buffer[113] != 0)flushElement(copy_frame, 15, 5, _cube_buffer[113]);
|
||||
if (_cube_buffer[114] != 0)flushElement(copy_frame, 12, 1, _cube_buffer[114]);
|
||||
if (_cube_buffer[115] != 0)flushElement(copy_frame, 5, 15, _cube_buffer[115]);
|
||||
if (_cube_buffer[116] != 0)flushElement(copy_frame, 2, 11, _cube_buffer[116]);
|
||||
if (_cube_buffer[117] != 0)flushElement(copy_frame, 16, 5, _cube_buffer[117]);
|
||||
if (_cube_buffer[118] != 0)flushElement(copy_frame, 11, 2, _cube_buffer[118]);
|
||||
if (_cube_buffer[119] != 0)flushElement(copy_frame, 5, 16, _cube_buffer[119]);
|
||||
if (_cube_buffer[120] != 0)flushElement(copy_frame, 3, 10, _cube_buffer[120]);
|
||||
if (_cube_buffer[121] != 0)flushElement(copy_frame, 13, 5, _cube_buffer[121]);
|
||||
if (_cube_buffer[122] != 0)flushElement(copy_frame, 10, 3, _cube_buffer[122]);
|
||||
if (_cube_buffer[123] != 0)flushElement(copy_frame, 5, 13, _cube_buffer[123]);
|
||||
if (_cube_buffer[124] != 0)flushElement(copy_frame, 4, 9, _cube_buffer[124]);
|
||||
if (_cube_buffer[125] != 0)flushElement(copy_frame, 14, 5, _cube_buffer[125]);
|
||||
if (_cube_buffer[126] != 0)flushElement(copy_frame, 9, 4, _cube_buffer[126]);
|
||||
if (_cube_buffer[127] != 0)flushElement(copy_frame, 5, 14, _cube_buffer[127]); // end green
|
||||
if (_cube_buffer[128] != 0)flushElement(copy_frame, 8, 9, _cube_buffer[128]); // start red
|
||||
if (_cube_buffer[129] != 0)flushElement(copy_frame, 1, 8, _cube_buffer[129]);
|
||||
if (_cube_buffer[130] != 0)flushElement(copy_frame, 13, 1, _cube_buffer[130]);
|
||||
if (_cube_buffer[131] != 0)flushElement(copy_frame, 9, 13, _cube_buffer[131]);
|
||||
if (_cube_buffer[132] != 0)flushElement(copy_frame, 8, 10, _cube_buffer[132]);
|
||||
if (_cube_buffer[133] != 0)flushElement(copy_frame, 2, 8, _cube_buffer[133]);
|
||||
if (_cube_buffer[134] != 0)flushElement(copy_frame, 14, 2, _cube_buffer[134]);
|
||||
if (_cube_buffer[135] != 0)flushElement(copy_frame, 10, 14, _cube_buffer[135]);
|
||||
if (_cube_buffer[136] != 0)flushElement(copy_frame, 8, 11, _cube_buffer[136]);
|
||||
if (_cube_buffer[137] != 0)flushElement(copy_frame, 3, 8, _cube_buffer[137]);
|
||||
if (_cube_buffer[138] != 0)flushElement(copy_frame, 15, 3, _cube_buffer[138]);
|
||||
if (_cube_buffer[139] != 0)flushElement(copy_frame, 11, 15, _cube_buffer[139]);
|
||||
if (_cube_buffer[140] != 0)flushElement(copy_frame, 8, 12, _cube_buffer[140]);
|
||||
if (_cube_buffer[141] != 0)flushElement(copy_frame, 4, 8, _cube_buffer[141]);
|
||||
if (_cube_buffer[142] != 0)flushElement(copy_frame, 16, 4, _cube_buffer[142]);
|
||||
if (_cube_buffer[143] != 0)flushElement(copy_frame, 12, 16, _cube_buffer[143]);
|
||||
if (_cube_buffer[144] != 0)flushElement(copy_frame, 7, 10, _cube_buffer[144]);
|
||||
if (_cube_buffer[145] != 0)flushElement(copy_frame, 1, 7, _cube_buffer[145]);
|
||||
if (_cube_buffer[146] != 0)flushElement(copy_frame, 16, 1, _cube_buffer[146]);
|
||||
if (_cube_buffer[147] != 0)flushElement(copy_frame, 10, 16, _cube_buffer[147]);
|
||||
if (_cube_buffer[148] != 0)flushElement(copy_frame, 7, 9, _cube_buffer[148]);
|
||||
if (_cube_buffer[149] != 0)flushElement(copy_frame, 2, 7, _cube_buffer[149]);
|
||||
if (_cube_buffer[150] != 0)flushElement(copy_frame, 15, 2, _cube_buffer[150]);
|
||||
if (_cube_buffer[151] != 0)flushElement(copy_frame, 9, 15, _cube_buffer[151]);
|
||||
if (_cube_buffer[152] != 0)flushElement(copy_frame, 7, 12, _cube_buffer[152]);
|
||||
if (_cube_buffer[153] != 0)flushElement(copy_frame, 3, 7, _cube_buffer[153]);
|
||||
if (_cube_buffer[154] != 0)flushElement(copy_frame, 14, 3, _cube_buffer[154]);
|
||||
if (_cube_buffer[155] != 0)flushElement(copy_frame, 12, 14, _cube_buffer[155]);
|
||||
if (_cube_buffer[156] != 0)flushElement(copy_frame, 7, 11, _cube_buffer[156]);
|
||||
if (_cube_buffer[157] != 0)flushElement(copy_frame, 4, 7, _cube_buffer[157]);
|
||||
if (_cube_buffer[158] != 0)flushElement(copy_frame, 13, 4, _cube_buffer[158]);
|
||||
if (_cube_buffer[159] != 0)flushElement(copy_frame, 11, 13, _cube_buffer[159]);
|
||||
if (_cube_buffer[160] != 0)flushElement(copy_frame, 11, 14, _cube_buffer[160]);
|
||||
if (_cube_buffer[161] != 0)flushElement(copy_frame, 6, 11, _cube_buffer[161]);
|
||||
if (_cube_buffer[162] != 0)flushElement(copy_frame, 1, 6, _cube_buffer[162]);
|
||||
if (_cube_buffer[163] != 0)flushElement(copy_frame, 14, 1, _cube_buffer[163]);
|
||||
if (_cube_buffer[164] != 0)flushElement(copy_frame, 6, 12, _cube_buffer[164]);
|
||||
if (_cube_buffer[165] != 0)flushElement(copy_frame, 2, 6, _cube_buffer[165]);
|
||||
if (_cube_buffer[166] != 0)flushElement(copy_frame, 13, 2, _cube_buffer[166]);
|
||||
if (_cube_buffer[167] != 0)flushElement(copy_frame, 12, 13, _cube_buffer[167]);
|
||||
if (_cube_buffer[168] != 0)flushElement(copy_frame, 6, 9, _cube_buffer[168]);
|
||||
if (_cube_buffer[169] != 0)flushElement(copy_frame, 3, 6, _cube_buffer[169]);
|
||||
if (_cube_buffer[170] != 0)flushElement(copy_frame, 16, 3, _cube_buffer[170]);
|
||||
if (_cube_buffer[171] != 0)flushElement(copy_frame, 9, 16, _cube_buffer[171]);
|
||||
if (_cube_buffer[172] != 0)flushElement(copy_frame, 6, 10, _cube_buffer[172]);
|
||||
if (_cube_buffer[173] != 0)flushElement(copy_frame, 4, 6, _cube_buffer[173]);
|
||||
if (_cube_buffer[174] != 0)flushElement(copy_frame, 15, 4, _cube_buffer[174]);
|
||||
if (_cube_buffer[175] != 0)flushElement(copy_frame, 10, 15, _cube_buffer[175]);
|
||||
if (_cube_buffer[176] != 0)flushElement(copy_frame, 5, 12, _cube_buffer[176]);
|
||||
if (_cube_buffer[177] != 0)flushElement(copy_frame, 1, 5, _cube_buffer[177]);
|
||||
if (_cube_buffer[178] != 0)flushElement(copy_frame, 15, 1, _cube_buffer[178]);
|
||||
if (_cube_buffer[179] != 0)flushElement(copy_frame, 12, 15, _cube_buffer[179]);
|
||||
if (_cube_buffer[180] != 0)flushElement(copy_frame, 5, 11, _cube_buffer[180]);
|
||||
if (_cube_buffer[181] != 0)flushElement(copy_frame, 2, 5, _cube_buffer[181]);
|
||||
if (_cube_buffer[182] != 0)flushElement(copy_frame, 16, 2, _cube_buffer[182]);
|
||||
if (_cube_buffer[183] != 0)flushElement(copy_frame, 11, 16, _cube_buffer[183]);
|
||||
if (_cube_buffer[184] != 0)flushElement(copy_frame, 5, 10, _cube_buffer[184]);
|
||||
if (_cube_buffer[185] != 0)flushElement(copy_frame, 3, 5, _cube_buffer[185]);
|
||||
if (_cube_buffer[186] != 0)flushElement(copy_frame, 13, 3, _cube_buffer[186]);
|
||||
if (_cube_buffer[187] != 0)flushElement(copy_frame, 10, 13, _cube_buffer[187]);
|
||||
if (_cube_buffer[188] != 0)flushElement(copy_frame, 5, 9, _cube_buffer[188]);
|
||||
if (_cube_buffer[189] != 0)flushElement(copy_frame, 4, 5, _cube_buffer[189]);
|
||||
if (_cube_buffer[190] != 0)flushElement(copy_frame, 14, 4, _cube_buffer[190]);
|
||||
if (_cube_buffer[191] != 0)flushElement(copy_frame, 9, 14, _cube_buffer[191]); // end red
|
||||
|
||||
(_cube__frame+1)->next=copy_frame;
|
||||
_cube_current_frame=_cube__frame+1;
|
||||
(_cube__frame + 1)->next = copy_frame;
|
||||
_cube_current_frame = _cube__frame + 1;
|
||||
}
|
||||
|
||||
|
||||
/*************************** INTERRUPT DISPLAY LEDS ***************************\
|
||||
| This is the interrupt function to turn on one led. After it turns that one |
|
||||
| on it will
|
||||
\******************************************************************************/
|
||||
byte pinsB[] = {P1B,P2B,P3B,P4B,P5B,P6B,P7B,P8B,P9B,P10B,P11B,P12B,P13B,P14B,P15B,P16B};
|
||||
byte pinsC[] = {P1C,P2C,P3C,P4C,P5C,P6C,P7C,P8C,P9C,P10C,P11C,P12C,P13C,P14C,P15C,P16C};
|
||||
byte pinsD[] = {P1D,P2D,P3D,P4D,P5D,P6D,P7D,P8D,P9D,P10D,P11D,P12D,P13D,P14D,P15D,P16D};
|
||||
| This is the interrupt function to turn on one led. After it turns that one |
|
||||
| on it will
|
||||
\******************************************************************************/
|
||||
byte pinsB[] = {P1B, P2B, P3B, P4B, P5B, P6B, P7B, P8B, P9B, P10B, P11B, P12B, P13B, P14B, P15B, P16B};
|
||||
byte pinsC[] = {P1C, P2C, P3C, P4C, P5C, P6C, P7C, P8C, P9C, P10C, P11C, P12C, P13C, P14C, P15C, P16C};
|
||||
byte pinsD[] = {P1D, P2D, P3D, P4D, P5D, P6D, P7D, P8D, P9D, P10D, P11D, P12D, P13D, P14D, P15D, P16D};
|
||||
#ifndef PWMMAX
|
||||
#define PWMMMAX 8
|
||||
#define PWMMMAX 8
|
||||
#endif
|
||||
#define FULL PWMMMAX
|
||||
#define HALF PWMMMAX/2
|
||||
|
|
@ -582,23 +597,34 @@ uint8_t DebouncePin(uint8_t pin) {
|
|||
return debounced_state;
|
||||
}
|
||||
|
||||
int currentTimer = 0;
|
||||
int maxTimer = 6250; // 100ms delay / 16uS interrupt time
|
||||
|
||||
//int nextState(int state) { return (state+1)%6; }
|
||||
int nextState(int state) { return (state+1)%2; }
|
||||
|
||||
// the interrupt function to display the leds
|
||||
ISR(TIMER2_OVF_vect) {
|
||||
if(DebouncePin(18)) {
|
||||
//nextState(currentState);
|
||||
if (not timerReset){
|
||||
currentTimer++;
|
||||
if (currentTimer >= maxTimer) {
|
||||
timerReset = true;
|
||||
currentTimer = 0;
|
||||
}
|
||||
}
|
||||
|
||||
if (DebouncePin(18)) {
|
||||
currentState = nextState(currentState);
|
||||
}
|
||||
|
||||
int pin1 = _cube_current_frame->pin1;
|
||||
int pin2 = _cube_current_frame->pin2;
|
||||
int count = (pin1 & 0xF0) | ((pin2 & 0xF0)>>4);
|
||||
pin1 = pin1&0x0F;
|
||||
pin2 = pin2&0x0F;
|
||||
int count = (pin1 & 0xF0) | ((pin2 & 0xF0) >> 4);
|
||||
pin1 = pin1 & 0x0F;
|
||||
pin2 = pin2 & 0x0F;
|
||||
PORTB = 0x00;
|
||||
PORTC = 0x10; // sets PC4 to INPUT_PULLUP for button
|
||||
PORTD = 0x00;
|
||||
if (count > pwmm){
|
||||
if (count > pwmm) {
|
||||
|
||||
DDRB = pinsB[pin1] | pinsB[pin2];
|
||||
DDRC = pinsC[pin1] | pinsC[pin2];
|
||||
|
|
@ -610,22 +636,22 @@ ISR(TIMER2_OVF_vect) {
|
|||
|
||||
}
|
||||
_cube_current_frame = _cube_current_frame->next;
|
||||
if (_cube_current_frame == _cube__frame+1){
|
||||
pwmm = (pwmm+1); //%PWMMMAX; // oooook so the modulus function is just a tincy bit toooooo slow when only one led is on
|
||||
if (_cube_current_frame == _cube__frame + 1) {
|
||||
pwmm = (pwmm + 1); //%PWMMMAX; // oooook so the modulus function is just a tincy bit toooooo slow when only one led is on
|
||||
if (pwmm == PWMMMAX) pwmm = 0; // by too slow i mean "to slow for the program to process an update" here is the fix
|
||||
}
|
||||
}
|
||||
|
||||
/******************************************************************************\
|
||||
| Some helpfull info for overflowing timers with different prescaler values |
|
||||
| 16000000 / ( 1*256) = 16000000 / 256 = 62500 Hz |
|
||||
| 16000000 / ( 8*256) = 16000000 / 2048 = ~7812 Hz |
|
||||
| 16000000 / ( 32*256) = 16000000 / 8192 = ~1953 Hz |
|
||||
| 16000000 / ( 64*256) = 16000000 / 16384 = ~976 Hz |
|
||||
| 16000000 / ( 128*256) = 16000000 / 32768 = ~488 Hz |
|
||||
| 16000000 / ( 256*256) = 16000000 / 65536 = ~244 Hz |
|
||||
| 16000000 / (1024*256) = 16000000 / 262144 = ~61 Hz |
|
||||
\******************************************************************************/
|
||||
| Some helpfull info for overflowing timers with different prescaler values |
|
||||
| 16000000 / ( 1*256) = 16000000 / 256 = 62500 Hz |
|
||||
| 16000000 / ( 8*256) = 16000000 / 2048 = ~7812 Hz |
|
||||
| 16000000 / ( 32*256) = 16000000 / 8192 = ~1953 Hz |
|
||||
| 16000000 / ( 64*256) = 16000000 / 16384 = ~976 Hz |
|
||||
| 16000000 / ( 128*256) = 16000000 / 32768 = ~488 Hz |
|
||||
| 16000000 / ( 256*256) = 16000000 / 65536 = ~244 Hz |
|
||||
| 16000000 / (1024*256) = 16000000 / 262144 = ~61 Hz |
|
||||
\******************************************************************************/
|
||||
|
||||
int animationTimer = 0;
|
||||
int animationMax = 0;
|
||||
|
|
@ -634,9 +660,9 @@ int animationMax = 0;
|
|||
ISR(TIMER1_OVF_vect) {
|
||||
animationTimer++;
|
||||
if (animationTimer >= animationMax) {
|
||||
continuePattern = false;
|
||||
//nextState(currentState);
|
||||
animationTimer=0;
|
||||
//continuePattern = false;
|
||||
currentState = nextState(currentState);
|
||||
animationTimer = 0;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
|
|
|||
218
planarFlop3D.ino
218
planarFlop3D.ino
|
|
@ -1,91 +1,159 @@
|
|||
/******************************* PLANAR FLOP 3D *******************************\
|
||||
| Version 2 of the planar flop, doing more complicated maths and 3D vectors |
|
||||
| 'n stuff. Making this function found the bug of reversed z axis line drawing |
|
||||
| |
|
||||
| Modified By: S. Dugre to use asynchronous timer |
|
||||
\******************************************************************************/
|
||||
|
||||
int planarCase;
|
||||
|
||||
void planarFlop3D() {
|
||||
continuePattern = true;
|
||||
int animationSpeed = 50;
|
||||
while (continuePattern) {
|
||||
|
||||
for (int y = 3; y > 0; y--) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 0, 3, z, 3, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
for (int x = 3; x > 0; x--) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 0, 3, z, x, 0, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
if (currentState != lastState) {
|
||||
|
||||
lastState = currentState;
|
||||
Serial.print("New State = ");
|
||||
Serial.println(currentState);
|
||||
|
||||
for (int x = 0; x < 3; x++) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 0, y, 0, x, y, 3);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
for (int z = 3; z > 0; z--) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 0, y, 0, 3, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
currentTimer = 0;
|
||||
maxTimer = 3125; // 50 ms
|
||||
|
||||
for (int z = 0; z < 3; z++) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 0, 0, x, 3, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
for (int y = 3; y > 0; y--) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 0, 0, x, y, 3);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
planarCase = 0;
|
||||
}
|
||||
|
||||
for (int y = 0; y < 3; y++) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 3, 0, z, 0, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
for (int x = 0; x < 3; x++) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 3, 0, z, x, 3, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
if (timerReset) {
|
||||
switch (planarCase) {
|
||||
case 0:
|
||||
for (int y = 3; y > 0; y--) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 0, 3, z, 3, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
for (int x = 3; x > 0; x--) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 3, y, 3, x, y, 0);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
for (int z = 0; z < 3; z++) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 3, y, 3, 0, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
case 1:
|
||||
for (int x = 3; x > 0; x--) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 0, 3, z, x, 0, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
for (int z = 3; z > 0; z--) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 3, 3, x, 0, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
for (int y = 0; y < 3; y++) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 3, 3, x, y, 0);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
delay(animationSpeed);
|
||||
}
|
||||
case 2:
|
||||
for (int x = 0; x < 3; x++) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 0, y, 0, x, y, 3);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 3:
|
||||
for (int z = 3; z > 0; z--) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 0, y, 0, 3, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 4:
|
||||
for (int z = 0; z < 3; z++) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 0, 0, x, 3, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 5:
|
||||
for (int y = 3; y > 0; y--) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 0, 0, x, y, 3);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 6:
|
||||
for (int y = 0; y < 3; y++) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 3, 0, z, 0, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 7:
|
||||
for (int x = 0; x < 3; x++) {
|
||||
for (int z = 0; z < 4; z++) drawLine(color, 3, 0, z, x, 3, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 8:
|
||||
for (int x = 3; x > 0; x--) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 3, y, 3, x, y, 0);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
case 9:
|
||||
for (int z = 0; z < 3; z++) {
|
||||
for (int y = 0; y < 4; y++) drawLine(color, 3, y, 3, 0, y, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 10:
|
||||
for (int z = 3; z > 0; z--) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 3, 3, x, 0, z);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase++;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
|
||||
case 11:
|
||||
for (int y = 0; y < 3; y++) {
|
||||
for (int x = 0; x < 4; x++) drawLine(color, x, 3, 3, x, y, 0);
|
||||
flushBuffer();
|
||||
clearBuffer();
|
||||
//delay(animationSpeed);
|
||||
planarCase = 0;
|
||||
currentTimer = 0;
|
||||
timerReset = false;
|
||||
}
|
||||
color = nextColor(color);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
|
|||
|
|
@ -1,5 +1,5 @@
|
|||
|
||||
|
||||
/*
|
||||
void timerInit() {
|
||||
animationDelay.setTimeout(100);
|
||||
animationDelay.setCallback(animationDelayCallback);
|
||||
|
|
@ -9,3 +9,4 @@ void animationDelayCallback() {
|
|||
animationDelayTiming = false;
|
||||
//Serial.println("timed out");
|
||||
}
|
||||
*/
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue