main.new.bak

#include <stdio.h>
#include <stdint.h>
#include <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <linux/spi/spidev.h>
#include <string.h>
#include <math.h>

#include "rgblib.h"
#include "font.h"

void draw_char(double xo, char c);
void setpixel(int x, int y, unsigned char r, unsigned char g, unsigned char b);
void aapixel(double x, double y, unsigned char r, unsigned char g, unsigned char b);

unsigned char buffer[LED_NUM*3];

unsigned int width;

int i;

double ctr;

char tr[] = {255,	0,	0,	255,	255,	0	};
char tg[] = {0,		255,	0,	255,	0,	255	};
char tb[] = {0,		0,	255,	0,	255,	255	};

void blit(){
	for(i=0; i<LED_NUM;i++){
		led_set(i,buffer[i*3+0],buffer[i*3+1],buffer[i*3+2]);
		buffer[i*3+0] = 0;
		buffer[i*3+1] = 0;
		buffer[i*3+2] = 0;
	}

}



#define STEP 0.01;


int main(int argc, char *argv[]){
	
	width = 40;
	ctr = 0;
	
	spi_init();	
	int ix,iy;	

	while(42){
		for(iy=0;iy<5;iy++){
			for(ix=0;ix<width;ix++){
				
				setpixel(ix,iy, (sin(ctr+ ix*1.2 + iy*iy*0.3)+1.0)*(sin(ctr+ ix*1.0 + iy*0.8)+1.0)*20.0,(sin(ctr+ ix*1.7 + iy*iy*0.5)+1.0)*(sin(ctr+ ix*0.7 + iy*0.9)+1.0)*20.0,0);
				
				
			}

		}	


		/*for(i=0;i<LED_NUM;i++){
			buffer[i*3+0] = (sin(ctr*i/2)+1)*20;
			buffer[i*3+1] = (cos(ctr*i/2)+1)*20;
			//buffer[i*3+2] = (sin(ctr*ctr*i/2)+1)*20;
			
		}*/
		

		blit();	
		update();
		
		
		ctr+= STEP;
		
		//usleep(3000);
	}
}


void draw_char(double xo, char c){
	int ix, iy;
	for(iy=0;iy<5;iy++){
		for(ix=0;ix<5;ix++){
			if(ix+xo < width || 1){
				unsigned char active = font[c][iy] & (1<<(ix+4));
				if(active >1) active = 1;
				//aapixel((ix+xo)*1.15,iy,active*(c*c)%127,active*(5*c)%127,active*(44137*c)%127);
				aapixel((ix+xo)*1.4,iy, active*(tr[c%6]/2), active*(tg[c%6]/2), active*(tb[c%6]/2) );
				//printf("%d",active);
			}	
		}
		//printf("\n");
	}
}


double dist(double a, double b){
	return sqrt(a*a+b*b);
}

void aapixel(double x, double y, unsigned char r, unsigned char g, unsigned char b){
	
	while(x<0) x += width;
	double xf = x - ((int)x);
		
	//while(y<0) x += width;
	//double yf = y - ((int)y);
	
	setpixel((int)x, (int)y, r*(1.0-xf), g*(1.0-xf), b*(1.0-xf));
	setpixel((int)x+1, (int)y, r*xf, g*xf, b*xf);
	
		
	//setpixel((int)x, (int)y+1, r*(1.0-yf), g*(1.0-yf), b*(1.0-yf));
	//setpixel((int)x+1, (int)y+1, r*xf, g*xf, b*xf);

	
	//setpixel((int)x, (int)y, r*dist(int(x)-x,int(y)-y, g*xf, b*xf);
	
}

void setpixel(int x, int y, unsigned char r, unsigned char g, unsigned char b){
	
	unsigned int pos = (y*width+(x%width));
	while(pos<0) pos += LED_NUM;
	if (pos < LED_NUM && pos >= 0){
		//led_set(pos, r, g, b);
		buffer[pos*3+0] += r;
		buffer[pos*3+1] += g;
		buffer[pos*3+2] += b;
	}
}