sdugre/charlie-cube
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

added asynchronous timer

Browse source
This commit is contained in:
Sean 2022-04-06 21:35:35 -04:00
parent 53879d6546
commit 62666ebb8c
6 changed files with 608 additions and 505 deletions
Download patch file Download diff file Expand all files Collapse all files

15
charlieCube.ino
View file

@ -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 "config.h"
#include "cubeplex.h" #include "cubeplex.h"
#include <timer.h> #include <timer.h>
Timer animationDelay;
bool animationDelayTiming = false;
int color = red; int color = red;
void setup() { void setup() {
Serial.begin(115200); Serial.begin(115200);
Serial.println("start program..."); Serial.println("start program...");
initCube(); initCube();
timerInit(); //timerInit();
currentState = CHASETHEDOT; currentState = CHASETHEDOT;
lastState = -1; lastState = -1;
@ -29,13 +25,14 @@ void loop() {
case CHASETHEDOT: case CHASETHEDOT:
chaseTheDot(); chaseTheDot();
//currentState = PLANARFLOP3D; break;
case RANDOMRAINBOW:
rainbow_random();
break; break;
case PLANARFLOP3D: case PLANARFLOP3D:
planarFlop3D(); planarFlop3D();
//currentState = CHASETHEDOT;
break; break;
} }
animationDelay.update();
} }

24
chaseTheDot.ino
View file

@ -1,9 +1,11 @@
/******************************** CHASE THE DOT *******************************\ /******************************** CHASE THE DOT *******************************\
| A single point of light moves around the cube randomly and changes colors | | A single point of light moves around the cube randomly and changes colors |
| when it tries to go out of bounds | | when it tries to go out of bounds |
| | | |
| Inspired By: Jonah Glick | | Inspired By: Jonah Glick |
| Written By: Asher Glick | | Written By: Asher Glick |
| |
| Modified By: S. Dugre to use asynchronous timer |
\******************************************************************************/ \******************************************************************************/
int xpos = 0; int xpos = 0;
@ -13,21 +15,23 @@ int zpos = 0;
int animationSpeed = 100; int animationSpeed = 100;
void chaseTheDot() { void chaseTheDot() {
//continuePattern = true;
if (currentState != lastState) { if (currentState != lastState) {
lastState = currentState; lastState = currentState;
Serial.print("last State = "); Serial.print("New State = ");
Serial.println(lastState); Serial.println(currentState);
xpos = 0; xpos = 0;
ypos = 0; ypos = 0;
zpos = 0; zpos = 0;
currentTimer = 0;
maxTimer = 6250; // 100 ms
} }
//while (continuePattern) { //while (continuePattern) {
if ( not animationDelayTiming) { if ( timerReset) {
switch (random(0, 6)) { switch (random(0, 6)) {
case 0: case 0:
if (xpos > 0) { if (xpos > 0) {
@ -75,8 +79,12 @@ void chaseTheDot() {
flushBuffer(); flushBuffer();
clearBuffer(); clearBuffer();
//delay(animationSpeed); //delay(animationSpeed);
animationDelay.start();
animationDelayTiming = true; //animationDelay.start();
Serial.println("start timer"); //animationDelayTiming = true;
//Serial.println("start timer");
currentTimer = 0;
timerReset = false;
} }
} }

3
config.h
View file

@ -3,7 +3,10 @@
typedef enum STATE { typedef enum STATE {
CHASETHEDOT, CHASETHEDOT,
RANDOMRAINBOW,
PLANARFLOP3D PLANARFLOP3D
}; };
STATE currentState, lastState; STATE currentState, lastState;
bool timerReset = true;

794
cubeplex.h
View file

@ -1,50 +1,50 @@
/********************************** SIGNATURE *********************************\ /********************************** SIGNATURE *********************************\
| ,, | | ,, |
| db `7MM | | db `7MM |
| ;MM: MM | | ;MM: MM |
| ,V^MM. ,pP"Ybd MMpMMMb. .gP"Ya `7Mb,od8 | | ,V^MM. ,pP"Ybd MMpMMMb. .gP"Ya `7Mb,od8 |
| ,M `MM 8I `" MM MM ,M' Yb MM' "' | | ,M `MM 8I `" MM MM ,M' Yb MM' "' |
| AbmmmqMA `YMMMa. MM MM 8M"""""" MM | | AbmmmqMA `YMMMa. MM MM 8M"""""" MM |
| A' VML L. I8 MM MM YM. , MM | | A' VML L. I8 MM MM YM. , MM |
| .AMA. .AMMA.M9mmmP'.JMML JMML.`Mbmmd'.JMML. | | .AMA. .AMMA.M9mmmP'.JMML JMML.`Mbmmd'.JMML. |
| | | |
| | | |
| ,, ,, | | ,, ,, |
| .g8"""bgd `7MM db `7MM | | .g8"""bgd `7MM db `7MM |
| .dP' `M MM MM | | .dP' `M MM MM |
| dM' ` MM `7MM ,p6"bo MM ,MP' | | dM' ` MM `7MM ,p6"bo MM ,MP' |
| MM MM MM 6M' OO MM ;Y | | MM MM MM 6M' OO MM ;Y |
| MM. `7MMF' MM MM 8M MM;Mm | | MM. `7MMF' MM MM 8M MM;Mm |
| `Mb. MM MM MM YM. , MM `Mb. | | `Mb. MM MM MM YM. , MM `Mb. |
| `"bmmmdPY .JMML..JMML.YMbmd'.JMML. YA. | | `"bmmmdPY .JMML..JMML.YMbmd'.JMML. YA. |
| | | |
\******************************************************************************/ \******************************************************************************/
/*********************************** LICENCE **********************************\ /*********************************** LICENCE **********************************\
| Copyright (c) 2012, Asher Glick | | Copyright (c) 2012, Asher Glick |
| All rights reserved. | | All rights reserved. |
| | | |
| Redistribution and use in source and binary forms, with or without | | Redistribution and use in source and binary forms, with or without |
| modification, are permitted provided that the following conditions are met: | | modification, are permitted provided that the following conditions are met: |
| | | |
| * Redistributions of source code must retain the above copyright notice, | | * Redistributions of source code must retain the above copyright notice, |
| this list of conditions and the following disclaimer. | | this list of conditions and the following disclaimer. |
| * Redistributions in binary form must reproduce the above copyright notice, | | * Redistributions in binary form must reproduce the above copyright notice, |
| this list of conditions and the following disclaimer in the documentation | | this list of conditions and the following disclaimer in the documentation |
| and/or other materials provided with the distribution. | | and/or other materials provided with the distribution. |
| | | |
| THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" | | THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | | AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | | IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE | | ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE |
| LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | | LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | | CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | | SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | | INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | | 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 | | ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| POSSIBILITY OF SUCH DAMAGE. | | POSSIBILITY OF SUCH DAMAGE. |
\******************************************************************************/ \******************************************************************************/
/*********** Modified by S. Dugre to work w/ my hardware***********************/ /*********** Modified by S. Dugre to work w/ my hardware***********************/
#ifndef _CUBEPLEX_H_ #ifndef _CUBEPLEX_H_
#define _CUBEPLEX_H_ #define _CUBEPLEX_H_
@ -54,7 +54,7 @@
#include "mappings.h" #include "mappings.h"
#include "niceTimer.h" #include "niceTimer.h"
struct _frame_light{ struct _frame_light {
char pin1; char pin1;
char pin2; char pin2;
struct _frame_light * next; struct _frame_light * next;
@ -67,19 +67,19 @@ char * _cube_buffer;
volatile bool continuePattern = false; volatile bool continuePattern = false;
/********************************** INIT CUBE *********************************\ /********************************** INIT CUBE *********************************\
| This function will allocate the memory required for the LED cube buffers. | | This function will allocate the memory required for the LED cube buffers. |
| which is about 600bytes | which is about 600bytes
\******************************************************************************/ \******************************************************************************/
void initCube() { 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); _cube_buffer = (char*)malloc(sizeof(char) * BUFFERSIZE);
for (int i = 0; i < BUFFERSIZE; i++) { for (int i = 0; i < BUFFERSIZE; i++) {
_cube_buffer[i] = 0; _cube_buffer[i] = 0;
} }
_cube__frame->next = _cube__frame; _cube__frame->next = _cube__frame;
_cube__frame->pin1=0; _cube__frame->pin1 = 0;
_cube__frame->pin2=0; _cube__frame->pin2 = 0;
_cube_current_frame = _cube__frame; _cube_current_frame = _cube__frame;
@ -93,14 +93,14 @@ void initCube() {
enableTimer1OverflowInterrupt(); enableTimer1OverflowInterrupt();
setTimer1Mode (TIMER1_NORMAL); setTimer1Mode (TIMER1_NORMAL);
} }
////////////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////////////
////////////////////////////// HELPER FUNCTIONS ////////////////////////////// ////////////////////////////// HELPER FUNCTIONS //////////////////////////////
////////////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////////////
/******************************** CLEAR BUFFER ********************************\ /******************************** CLEAR BUFFER ********************************\
| This function will clear the buffer that you can write to, this will allow | | This function will clear the buffer that you can write to, this will allow |
| you to draw an eniterly new frame int othe buffer | you to draw an eniterly new frame int othe buffer
\******************************************************************************/ \******************************************************************************/
void clearBuffer () { void clearBuffer () {
for (int i = 0; i < BUFFERSIZE; i++) { for (int i = 0; i < BUFFERSIZE; i++) {
_cube_buffer[i] = 0; _cube_buffer[i] = 0;
@ -108,38 +108,44 @@ void clearBuffer () {
} }
/**************************** NEXT COLOR FUNCTIONS ****************************\ /**************************** NEXT COLOR FUNCTIONS ****************************\
| These functions cycle thorugh | | These functions cycle thorugh |
| the three primary colors red, greed, and blue | | the three primary colors red, greed, and blue |
| the secondary colors purple, teal, yellow (every pairing of two leds) | | the secondary colors purple, teal, yellow (every pairing of two leds) |
| the ALL THE COLORS (red,green,blue,purple,teal,yellow,white) | | the ALL THE COLORS (red,green,blue,purple,teal,yellow,white) |
\******************************************************************************/ \******************************************************************************/
int nextPrimaryColor(int color) { return (color+1)%3; } int nextPrimaryColor(int color) {
int nextSecondaryColor(int color) { return ((color+1)%3)+3; } return (color + 1) % 3;
int nextColor(int color) { return (color+1)%7; } }
int nextSecondaryColor(int color) {
return ((color + 1) % 3) + 3;
}
int nextColor(int color) {
return (color + 1) % 7;
}
/********************************** SWAP INT **********************************\ /********************************** SWAP INT **********************************\
| This function uses the fast xor swap to change the values of the two | | This function uses the fast xor swap to change the values of the two |
| intigers passed into the function | | intigers passed into the function |
\******************************************************************************/ \******************************************************************************/
void swapint(int & one, int & two) { void swapint(int & one, int & two) {
one = one^two; one = one ^ two;
two = one^two; two = one ^ two;
one = one^two; one = one ^ two;
} }
/******************************* ROUND CLOSTEST *******************************\ /******************************* ROUND CLOSTEST *******************************\
| This function takes in a numberator and denominator and rounds to the | | This function takes in a numberator and denominator and rounds to the |
| nearist number instead of trunkating. It does this by calculating an extra | | nearist number instead of trunkating. It does this by calculating an extra |
| digit (this function should be changes to be more accurate) | | digit (this function should be changes to be more accurate) |
\******************************************************************************/ \******************************************************************************/
int roundClostest(int numerator, int denominator) { int roundClostest(int numerator, int denominator) {
numerator = (numerator << 1)/denominator; numerator = (numerator << 1) / denominator;
int output = (numerator>>1) + (numerator % 2); int output = (numerator >> 1) + (numerator % 2);
return output; return output;
} }
////////////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////////////
/////////////////////////////////// DRAWING ////////////////////////////////// /////////////////////////////////// DRAWING //////////////////////////////////
////////////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////////////
#define B 0 #define B 0
@ -161,188 +167,197 @@ int roundClostest(int numerator, int denominator) {
#define off -7 #define off -7
/********************************** DRAW LED **********************************\ /********************************** DRAW LED **********************************\
| This function turns on leds at a specified position. Depending on which | | This function turns on leds at a specified position. Depending on which |
| color this function turns on different colors of the LED | | color this function turns on different colors of the LED |
\******************************************************************************/ \******************************************************************************/
void drawLed(int color, int brightness, int x, int y, int z) { void drawLed(int color, int brightness, int x, int y, int z) {
if ((color/3)==0) { // single color (red green blue) 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)%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; _cube_buffer[(((color + 1) % 3) * 64) + (x * 16) + (y * 4) + z] += 0;
} }
else if ((color/3)==1) { // double color (teal yellow purple) else if ((color / 3) == 1) { // double color (teal yellow purple)
_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] += brightness; _cube_buffer[(((color + 1) % 3) * 64) + (x * 16) + (y * 4) + z] += brightness;
} }
else if (color == 6){ // all colors (white) else if (color == 6) { // all colors (white)
_cube_buffer[((0)*64)+(x*16)+(y*4)+z] += brightness; _cube_buffer[((0) * 64) + (x * 16) + (y * 4) + z] += brightness;
_cube_buffer[((1)*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; _cube_buffer[((2) * 64) + (x * 16) + (y * 4) + z] += brightness;
} }
else if (color == -7) { else if (color == -7) {
_cube_buffer[((0)*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[((1) * 64) + (x * 16) + (y * 4) + z] = 0;
_cube_buffer[((2)*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) { void drawLed(int color, int x, int y, int z) {
drawLed(color,255,x,y,z); drawLed(color, 255, x, y, z);
} }
/********************************** DRAW BOX **********************************\ /********************************** 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) { 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 (startx > endx) swapint(startx, endx);
if (starty > endy) swapint(starty,endy); if (starty > endy) swapint(starty, endy);
if (startz > endz) swapint(startz,endz); if (startz > endz) swapint(startz, endz);
for (int i = startx; i <= endx; i++) { for (int i = startx; i <= endx; i++) {
for (int j = starty; j <= endy; j++) { for (int j = starty; j <= endy; j++) {
for (int k = startz; k <= endz; k++) { 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) { 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 ******************************\ /******************************* 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) { 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 (startx > endx) swapint(startx, endx);
if (starty > endy) swapint(starty,endy); if (starty > endy) swapint(starty, endy);
if (startz > endz) swapint(startz,endz); if (startz > endz) swapint(startz, endz);
for (int i = startx; i <= endx; i ++) { for (int i = startx; i <= endx; i ++) {
for (int j = starty; j <= endy; j ++) { for (int j = starty; j <= endy; j ++) {
for (int k = startz; k <= endz; k ++) { for (int k = startz; k <= endz; k ++) {
if (i == startx || i == endx || j == starty || j == endy || k == startz || k == endz) { 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) { 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 ******************************\ /****************************** 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) { 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 (startx > endx) swapint(startx, endx);
if (starty > endy) swapint(starty,endy); if (starty > endy) swapint(starty, endy);
if (startz > endz) swapint(startz,endz); if (startz > endz) swapint(startz, endz);
for (int i = startx; i <= endx; i++) { for (int i = startx; i <= endx; i++) {
for (int j = starty; j <= endy; j++) { for (int j = starty; j <= endy; j++) {
for (int k = startz; k <= endz; k++) { for (int k = startz; k <= endz; k++) {
int sum = (i == startx) + (i == endy) + (j == starty) + (j == endy) + (k == startz) + (k == endz); int sum = (i == startx) + (i == endy) + (j == starty) + (j == endy) + (k == startz) + (k == endz);
if (sum >= 2){ if (sum >= 2) {
drawLed(color,brightness,i,j,k); drawLed(color, brightness, i, j, k);
} }
} }
} }
} }
} }
void drawBoxOutline(int color, int startx, int starty, int startz, int endx, int endy, int endz) { 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 *******************************\ /******************************* DRAW BOX WALLS *******************************\
| This function will draw the virtical walls and all four sides of a defined | | This function will draw the virtical walls and all four sides of a defined |
| box | | box |
\******************************************************************************/ \******************************************************************************/
void drawBoxWalls(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) { 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 (startx > endx) swapint(startx, endx);
if (starty > endy) swapint(starty,endy); if (starty > endy) swapint(starty, endy);
if (startz > endz) swapint(startz,endz); if (startz > endz) swapint(startz, endz);
for (int i = startz; i <= endz; i++) { for (int i = startz; i <= endz; i++) {
// draw y walls // draw y walls
for (int j = starty; j <= endy; j++) { for (int j = starty; j <= endy; j++) {
drawLed(color,brightness,startx,j,i); drawLed(color, brightness, startx, j, i);
drawLed(color,brightness,endx,j,i); drawLed(color, brightness, endx, j, i);
} }
// draw x walls // draw x walls
for (int j = startx; j <= endx; j++) { for (int j = startx; j <= endx; j++) {
drawLed(color,brightness,j,starty,i); drawLed(color, brightness, j, starty, i);
drawLed(color,brightness,j,endy,i); drawLed(color, brightness, j, endy, i);
} }
} }
} }
void drawBoxWalls(int color, int startx, int starty, int startz, int endx, int endy, int endz) { 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 *********************************\ /********************************** DRAW LINE *********************************\
| This function will attempt to draw a line between the two points given. Due | | 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 | | to the limited avalibility of pixels the best approximation is chosen for |
| each pixel value | | each pixel value |
\******************************************************************************/ \******************************************************************************/
void drawLine(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) { void drawLine(int color, int brightness, int startx, int starty, int startz, int endx, int endy, int endz) {
bool reverseX = false; bool reverseX = false;
bool reverseY = false; bool reverseY = false;
bool reverseZ = false; bool reverseZ = false;
if (startx > endx) {swapint(startx,endx);reverseX=true;} if (startx > endx) {
if (starty > endy) {swapint(starty,endy);reverseY=true;} swapint(startx, endx);
if (startz > endz) {swapint(startz,endz);reverseZ=true;} reverseX = true;
}
if (starty > endy) {
swapint(starty, endy);
reverseY = true;
}
if (startz > endz) {
swapint(startz, endz);
reverseZ = true;
}
int delx = endx - startx; int delx = endx - startx;
int dely = endy - starty; int dely = endy - starty;
int delz = endz - startz; 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++) { for (int i = 0; i < longest; i++) {
int xpos; int xpos;
if (reverseX) xpos = roundClostest(((longest-i)*delx),longest) + startx; if (reverseX) xpos = roundClostest(((longest - i) * delx), longest) + startx;
else xpos = roundClostest((i*delx),longest) + startx; else xpos = roundClostest((i * delx), longest) + startx;
int ypos; int ypos;
if (reverseY) ypos = roundClostest(((longest-i)*dely),longest) + starty; if (reverseY) ypos = roundClostest(((longest - i) * dely), longest) + starty;
else ypos = roundClostest((i*dely),longest) + starty; else ypos = roundClostest((i * dely), longest) + starty;
int zpos; int zpos;
if (reverseZ) zpos = roundClostest(((longest-i)*delz),longest) + startz; if (reverseZ) zpos = roundClostest(((longest - i) * delz), longest) + startz;
else zpos = roundClostest((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 (reverseX) swapint(startx, endx);
if (reverseY) swapint(starty,endy); if (reverseY) swapint(starty, endy);
if (reverseZ) swapint(startz,endz); if (reverseZ) swapint(startz, endz);
drawLed(color,brightness,endx,endy,endz); drawLed(color, brightness, endx, endy, endz);
} }
void drawLine(int color, int startx, int starty, int startz, int endx, int endy, int 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 pwmm = 0;
int display_length; int display_length;
void flushElement(_frame_light* &copy_frame,int pin1,int pin2,int brightness) { void flushElement(_frame_light* &copy_frame, int pin1, int pin2, int brightness) {
pin1--; pin1--;
pin2--; pin2--;
(copy_frame+1)->next=copy_frame; (copy_frame + 1)->next = copy_frame;
copy_frame++; copy_frame++;
copy_frame->pin1=pin1 | ( brightness & 0xF0); copy_frame->pin1 = pin1 | ( brightness & 0xF0);
copy_frame->pin2=pin2 | ((brightness & 0x0F) << 4); copy_frame->pin2 = pin2 | ((brightness & 0x0F) << 4);
display_length++; display_length++;
} }
/******************************** FLUSH BUFFER ********************************\ /******************************** FLUSH BUFFER ********************************\
| This takes the buffer frame and sets the display memory to match, because | | 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 | | 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 | | 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 | | 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 | | check to see if it is at the end of the loop |
\******************************************************************************/ \******************************************************************************/
void flushBuffer() { void flushBuffer() {
_frame_light * copy_frame = _cube__frame; _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 //TODO the pins values need to be changed so that the mapping.h file can
// change them using #defines // change them using #defines
if (_cube_buffer[ 0] != 0)flushElement(copy_frame,13, 9,_cube_buffer[ 0]); // start blue 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[ 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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[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[191] != 0)flushElement(copy_frame, 9, 14, _cube_buffer[191]); // end red
(_cube__frame+1)->next=copy_frame; (_cube__frame + 1)->next = copy_frame;
_cube_current_frame=_cube__frame+1; _cube_current_frame = _cube__frame + 1;
} }
/*************************** INTERRUPT DISPLAY LEDS ***************************\ /*************************** INTERRUPT DISPLAY LEDS ***************************\
| This is the interrupt function to turn on one led. After it turns that one | | This is the interrupt function to turn on one led. After it turns that one |
| on it will | on it will
\******************************************************************************/ \******************************************************************************/
byte pinsB[] = {P1B,P2B,P3B,P4B,P5B,P6B,P7B,P8B,P9B,P10B,P11B,P12B,P13B,P14B,P15B,P16B}; 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 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}; byte pinsD[] = {P1D, P2D, P3D, P4D, P5D, P6D, P7D, P8D, P9D, P10D, P11D, P12D, P13D, P14D, P15D, P16D};
#ifndef PWMMAX #ifndef PWMMAX
#define PWMMMAX 8 #define PWMMMAX 8
#endif #endif
#define FULL PWMMMAX #define FULL PWMMMAX
#define HALF PWMMMAX/2 #define HALF PWMMMAX/2
@ -582,23 +597,34 @@ uint8_t DebouncePin(uint8_t pin) {
return debounced_state; 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 // the interrupt function to display the leds
ISR(TIMER2_OVF_vect) { ISR(TIMER2_OVF_vect) {
if(DebouncePin(18)) { if (not timerReset){
//nextState(currentState); currentTimer++;
if (currentTimer >= maxTimer) {
timerReset = true;
currentTimer = 0;
}
} }
if (DebouncePin(18)) {
currentState = nextState(currentState);
}
int pin1 = _cube_current_frame->pin1; int pin1 = _cube_current_frame->pin1;
int pin2 = _cube_current_frame->pin2; int pin2 = _cube_current_frame->pin2;
int count = (pin1 & 0xF0) | ((pin2 & 0xF0)>>4); int count = (pin1 & 0xF0) | ((pin2 & 0xF0) >> 4);
pin1 = pin1&0x0F; pin1 = pin1 & 0x0F;
pin2 = pin2&0x0F; pin2 = pin2 & 0x0F;
PORTB = 0x00; PORTB = 0x00;
PORTC = 0x10; // sets PC4 to INPUT_PULLUP for button PORTC = 0x10; // sets PC4 to INPUT_PULLUP for button
PORTD = 0x00; PORTD = 0x00;
if (count > pwmm){ if (count > pwmm) {
DDRB = pinsB[pin1] | pinsB[pin2]; DDRB = pinsB[pin1] | pinsB[pin2];
DDRC = pinsC[pin1] | pinsC[pin2]; DDRC = pinsC[pin1] | pinsC[pin2];
@ -610,22 +636,22 @@ ISR(TIMER2_OVF_vect) {
} }
_cube_current_frame = _cube_current_frame->next; _cube_current_frame = _cube_current_frame->next;
if (_cube_current_frame == _cube__frame+1){ 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 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 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 | | Some helpfull info for overflowing timers with different prescaler values |
| 16000000 / ( 1*256) = 16000000 / 256 = 62500 Hz | | 16000000 / ( 1*256) = 16000000 / 256 = 62500 Hz |
| 16000000 / ( 8*256) = 16000000 / 2048 = ~7812 Hz | | 16000000 / ( 8*256) = 16000000 / 2048 = ~7812 Hz |
| 16000000 / ( 32*256) = 16000000 / 8192 = ~1953 Hz | | 16000000 / ( 32*256) = 16000000 / 8192 = ~1953 Hz |
| 16000000 / ( 64*256) = 16000000 / 16384 = ~976 Hz | | 16000000 / ( 64*256) = 16000000 / 16384 = ~976 Hz |
| 16000000 / ( 128*256) = 16000000 / 32768 = ~488 Hz | | 16000000 / ( 128*256) = 16000000 / 32768 = ~488 Hz |
| 16000000 / ( 256*256) = 16000000 / 65536 = ~244 Hz | | 16000000 / ( 256*256) = 16000000 / 65536 = ~244 Hz |
| 16000000 / (1024*256) = 16000000 / 262144 = ~61 Hz | | 16000000 / (1024*256) = 16000000 / 262144 = ~61 Hz |
\******************************************************************************/ \******************************************************************************/
int animationTimer = 0; int animationTimer = 0;
int animationMax = 0; int animationMax = 0;
@ -634,9 +660,9 @@ int animationMax = 0;
ISR(TIMER1_OVF_vect) { ISR(TIMER1_OVF_vect) {
animationTimer++; animationTimer++;
if (animationTimer >= animationMax) { if (animationTimer >= animationMax) {
continuePattern = false; //continuePattern = false;
//nextState(currentState); currentState = nextState(currentState);
animationTimer=0; animationTimer = 0;
} }
} }
#endif #endif

218
planarFlop3D.ino
View file

@ -1,91 +1,159 @@
/******************************* PLANAR FLOP 3D *******************************\ /******************************* PLANAR FLOP 3D *******************************\
| Version 2 of the planar flop, doing more complicated maths and 3D vectors | | 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 | | '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() { void planarFlop3D() {
continuePattern = true;
int animationSpeed = 50;
while (continuePattern) {
for (int y = 3; y > 0; y--) { if (currentState != lastState) {
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);
}
lastState = currentState;
Serial.print("New State = ");
Serial.println(currentState);
for (int x = 0; x < 3; x++) { currentTimer = 0;
for (int y = 0; y < 4; y++) drawLine(color, 0, y, 0, x, y, 3); maxTimer = 3125; // 50 ms
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);
}
for (int z = 0; z < 3; z++) { planarCase = 0;
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);
}
for (int y = 0; y < 3; y++) { if (timerReset) {
for (int z = 0; z < 4; z++) drawLine(color, 3, 0, z, 0, y, z); switch (planarCase) {
flushBuffer(); case 0:
clearBuffer(); for (int y = 3; y > 0; y--) {
delay(animationSpeed); for (int z = 0; z < 4; z++) drawLine(color, 0, 3, z, 3, y, z);
} flushBuffer();
for (int x = 0; x < 3; x++) { clearBuffer();
for (int z = 0; z < 4; z++) drawLine(color, 3, 0, z, x, 3, z); //delay(animationSpeed);
flushBuffer(); planarCase++;
clearBuffer(); currentTimer = 0;
delay(animationSpeed); timerReset = false;
} }
for (int x = 3; x > 0; x--) { case 1:
for (int y = 0; y < 4; y++) drawLine(color, 3, y, 3, x, y, 0); for (int x = 3; x > 0; x--) {
flushBuffer(); for (int z = 0; z < 4; z++) drawLine(color, 0, 3, z, x, 0, z);
clearBuffer(); flushBuffer();
delay(animationSpeed); clearBuffer();
} //delay(animationSpeed);
for (int z = 0; z < 3; z++) { planarCase++;
for (int y = 0; y < 4; y++) drawLine(color, 3, y, 3, 0, y, z); currentTimer = 0;
flushBuffer(); timerReset = false;
clearBuffer(); }
delay(animationSpeed);
}
for (int z = 3; z > 0; z--) { case 2:
for (int x = 0; x < 4; x++) drawLine(color, x, 3, 3, x, 0, z); for (int x = 0; x < 3; x++) {
flushBuffer(); for (int y = 0; y < 4; y++) drawLine(color, 0, y, 0, x, y, 3);
clearBuffer(); flushBuffer();
delay(animationSpeed); clearBuffer();
} //delay(animationSpeed);
for (int y = 0; y < 3; y++) { planarCase++;
for (int x = 0; x < 4; x++) drawLine(color, x, 3, 3, x, y, 0); currentTimer = 0;
flushBuffer(); timerReset = false;
clearBuffer(); }
delay(animationSpeed);
} 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); color = nextColor(color);
}
} }
} }

3
timers.ino
View file

@ -1,5 +1,5 @@
/*
void timerInit() { void timerInit() {
animationDelay.setTimeout(100); animationDelay.setTimeout(100);
animationDelay.setCallback(animationDelayCallback); animationDelay.setCallback(animationDelayCallback);
@ -9,3 +9,4 @@ void animationDelayCallback() {
animationDelayTiming = false; animationDelayTiming = false;
//Serial.println("timed out"); //Serial.println("timed out");
} }
*/