/*
 * cube.c
 *
 * Copyright 2011 Thomas Buck <xythobuz@me.com>
 * Copyright 2011 Max Nuding <max.nuding@gmail.com>
 * Copyright 2011 Felix Bäder <baeder.felix@gmail.com>
 *
 * This file is part of LED-Cube.
 *
 * LED-Cube is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * LED-Cube is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with LED-Cube.  If not, see <http://www.gnu.org/licenses/>.
 */
#include <avr/io.h>
#include <avr/interrupt.h>
#include <stdlib.h>

#include "uart.h"
#include "cube.h"

#ifndef F_CPU
#define F_CPU 16000000L
#endif

volatile uint8_t _isrCounter = 0;
volatile uint8_t **imgBuffer = NULL; // imgBuffer[8][8]
volatile uint8_t changedFlag = 0;
volatile uint8_t imgFlag = 0;
volatile uint8_t layer = 0;

inline void delay_ns(int16_t ns);
inline void isrCall(void);

void setImage(uint8_t **img) {
	uint8_t i = 0, j;

	changedFlag = 1;
	for (; i < 8; i++) {
		for (j = 0; j < 8; j++) {
			imgBuffer[i][j] = img[i][j];
		}
	}
}

uint8_t isFinished(void) {
	return imgFlag;
}

void init(void) {
	uint8_t ctr = 0;

	TCCR1A |= (1 << WGM12); // CTC Mode
	TCCR1B |= (1 << CS10); // No prescaler
	OCR1A = 3968;
	TIMSK = (1 << OCIE1A); // Enable Overflow Interrupt

	// We just assume this works, because after reset,
	// enough Memory should be available...
	imgBuffer = malloc(8 * sizeof(uint8_t*));

	for(ctr = 0; ctr < 8; ctr++) {
		// Same reasoning here...
		imgBuffer[ctr] = malloc(8 * sizeof(uint8_t));
	}

	sei(); // Enable Interrupts
}

void close(void) {
	uint8_t ctr = 0;
	for (; ctr < 8; ctr++) {
		free((uint8_t *)imgBuffer[ctr]);
	}
	free(imgBuffer);
	TIMSK &= ~(1 << OCIE1A); // Disable interrupt
}

// Count to 3968 21 times...
ISR(TIMER1_COMPA_vect) {
	if (_isrCounter < 20) {
		_isrCounter++;
	} else {
		_isrCounter = 0;
		isrCall();
	}
}

// Data is sent to 8 Fet bits...
inline void setFet(uint8_t data) {
	PORTD = (data & ~(3)); // Doesn't interfere with serial communication...
	PORTB &= ~(24);
	PORTB |= ((data << 3) & 24);
}

// Give id of latch, 0 - 7
inline void selectLatch(uint8_t latchNr) {
	PORTC = 0;
	if (latchNr < 8) {
		PORTC = 1 << latchNr;
	}
}

inline void setLatch(uint8_t latchNr, uint8_t data) {
	setFet(0); // All LEDs off
	selectLatch(latchNr); // Activate current latch
	PORTA = data; // Put latch data
	delay_ns(LATCHDELAY); // Wait for latch
	selectLatch(8); // Deactivate all latches
	setFet(1 << latchNr); // Activate current plane
}

inline void isrCall(void) {
	uint8_t latchCtr = 0;

	if (changedFlag != 0) {
		// The picture changed. Restart!
		layer = 0;
		imgFlag = 0;
		changedFlag = 0;
	}

	for (; latchCtr < 8; latchCtr++) {
		setLatch(latchCtr, imgBuffer[layer][latchCtr]); // Put out all the data
	}
	
	// Select next layer
	if (layer < 7) {
		layer++;
	} else {
		layer = 0;
		imgFlag = 1; // Finished
	}
}

inline void delay_ns(int16_t ns) {
	// minimum 63 nanoseconds (= 1 tick)
	for (;ns > 0; ns -= 63)
		asm volatile("nop"::);
}