//
// STC15 RPN calculator
//

#include <stdint.h>
#include "lcd.h"
#include "key.h"
#include "decn/decn.h"
#include "calc.h"
#include "utils.h"
#ifdef DESKTOP
#include <stdio.h>
#include <QSemaphore>
#else
#include "stc15.h"
#endif

#define FOSC 11583000


static const char KEY_MAP[20] = {
	'c', '<', 'r', 'm',
	'/', '9', '8', '7',
	'*', '6', '5', '4',
	'-', '3', '2', '1',
	'+', '=', '.', '0'
};


#ifdef DESKTOP
QSemaphore KeysAvailable(0);
QSemaphore LcdAvailable(1);
#endif

int8_t NewKeyBuf[4];
volatile uint8_t new_key_write_i;
volatile uint8_t new_key_read_i;
volatile uint8_t NewKeyEmpty;

#define INCR_NEW_KEY_I(i) i = (i + 1) & 3

//#define TRACK_TIME
#ifdef TRACK_TIME
volatile uint8_t SecCount;
#endif


void timer0_isr() SDCC_ISR(1,1)
{
#ifdef TRACK_TIME
	static uint8_t count = 0;
	static uint8_t min_count = 0, hour_count = 0;
#endif

	//scan keyboard
	KeyScan();
	if (NewKeyPressed != -1){
		if (!NewKeyEmpty && (new_key_write_i == new_key_read_i)){
			//do not overwrite keymap currently being processed
//			INCR_NEW_KEY_I(new_key_write_i);
#ifdef DESKTOP
			printf("ERROR: key fifo full\n");
#endif
			return;
		}
		NewKeyBuf[new_key_write_i] = NewKeyPressed;
		INCR_NEW_KEY_I(new_key_write_i);
		NewKeyEmpty = 0;
	}

	if (Keys[0] == 8 && Keys[4] == 8){
		TURN_OFF();
	}

	//track time
#ifdef TRACK_TIME
	count++;
	if (count == 200){
		count = 0;
		SecCount++;
		if (SecCount == 60){
			SecCount = 0;
			min_count++;
			if (min_count == 60){
				min_count = 0;
				hour_count++;
			}
		}
	}
#endif
}


#ifdef DESKTOP
void Timer0Init(void) { }
static void latch_on(void){ }
#else
// Call timer0_isr() 200/sec: 5 ms period
// Initialize the timer count so that it overflows after 0.01 sec
// THTL = 0x10000 - FOSC / 200 = 0x10000 - 115830 = 7621 = 0x1DC5
void Timer0Init(void)
{
	// TMOD = 0;    // default: 16-bit auto-reload
	AUXR |= 0x80;   // use undivided SYSclk for timer0
	// Initial values of TL0 and TH0 are stored in hidden reload registers: RL_TL0 and RL_TH0
	TL0 = 0xC5;		// Initial timer value
	TH0 = 0x1D;		// Initial timer value
	TF0 = 0;		// Clear overflow flag
	TR0 = 1;		// Timer0 start run
	ET0 = 1;		// Enable timer0 interrupt
	EA  = 1;		// Enable global interrupt
}

//keep soft power switch latched on
static void latch_on(void)
{
	//set (P3_2) as push pull output
	P3M1 &= ~(0x4);
	P3M0 |= (0x4);
	//latch on
	P3_2 = 1;
}
#endif //!DESKTOP


__xdata char EntryBuf[MAX_CHARS_PER_LINE + 1];
__xdata uint8_t ExpBuf[2];
__xdata const char VER_STR[32+1] = "STC RPN         Calculator v1.07";


enum {
	ENTERING_DONE_CLEARED,
	ENTERING_DONE,
	ENTERING_SIGNIF,
	ENTERING_FRAC,
	ENTERING_EXP,
	ENTERING_EXP_NEG
};
static uint8_t Entry_i = 0;
static uint8_t EnteringExp = ENTERING_DONE;
static uint8_t Exp_i = 0;
static int8_t I_Key;

static inline uint8_t is_entering_done(void){
	return EnteringExp <= ENTERING_DONE;
}

static void entering_done(void){
	//reset pointers
	Entry_i = 0;
	Exp_i = 0;
	ExpBuf[0] = 0;
	ExpBuf[1] = 0;
}

static inline void finish_process_entry(void){
	if (!is_entering_done()){
		//finish entry
		int8_t exponent; //exponent is only 2 digits
		exponent = 10*ExpBuf[1] + ExpBuf[0];
		if ( EnteringExp == ENTERING_EXP_NEG){
			exponent = -exponent;
		}
		EntryBuf[Entry_i] = '\0';
		push_decn(EntryBuf, exponent);
		//reset to done
		entering_done();
		//track entry for RCL and lastX
		if (NoLift){
#ifdef DESKTOP
			printf("no lift==2\n");
#endif
			NoLift++;
		}
	}
	//process cmd
	process_cmd(KEY_MAP[I_Key]);
	EnteringExp = ENTERING_DONE;
	NoLift = 0;
}

#ifdef DESKTOP
static void print_entry_bufs(void){
	printf("EntryBuf:~%s~ (%d)\n", EntryBuf, EnteringExp);
	printf("ExpBuf:%c%c\n", '0'+ExpBuf[1], '0'+ExpBuf[0]);
}
#endif

//#define DEBUG_UPTIME
/*********************************************/
#ifdef DESKTOP
uint8_t ExitCalcMain;
int calc_main()
#else
int main()
#endif
{
	int8_t disp_exponent;
	NewKeyEmpty = 1; //initially empty
#ifdef DEBUG_KEYS
	uint8_t j = 0;
	const uint8_t* keys;
	uint8_t key_i;
#endif

#ifdef DEBUG_UPTIME
	uint32_t i;
#endif

	latch_on();
	LCD_Open();
	KeyInit();
	Timer0Init(); //for reading keyboard
	BACKLIGHT_ON(); //turn on led backlight

	ExpBuf[0] = 0;
	ExpBuf[1] = 0;

	LCD_OutString_Initial(VER_STR, 32);
#ifdef DESKTOP
	LcdAvailable.release();
#endif

#ifdef DEBUG_UPTIME
	i = 0;
#endif
	// LOOP
	while (1)
	{
		//turn off?
		if (Keys[0] == 8 && Keys[4] == 8){
			//check if both shift (mode) and 0 key are held to turn off
			//(should work even if rest of calculator is in inifite loop,
			// since this is checked within ISR)
			TURN_OFF();
		}
#ifdef DESKTOP
		if (ExitCalcMain){
			return 0;
		}
#endif

#ifdef DEBUG_UPTIME
		LCD_GoTo(0,0);
		u32str(i++, Buf, 10);
		LCD_OutString(Buf, MAX_CHARS_PER_LINE);
#endif //DEBUG_UPTIME

#ifdef DEBUG_KEYS
		//keyboard debug
		keys = DebugGetKeys();
		for (key_i = 0; key_i < 5; key_i++){
			LCD_OutNibble(keys[key_i]);
		}
		TERMIO_PutChar(',');
		//counter
		if (SecCount == 0){
			LCD_OutString("  ");
		} else if (SecCount < 10){
			TERMIO_PutChar(' ');
			LCD_OutString(u32str(SecCount, Buf, 10));
		} else {
			LCD_OutString(u32str(SecCount, Buf, 10));
		}
#endif //DEBUG_KEYS


		///get new key
#ifdef DESKTOP
		KeysAvailable.acquire();
#endif
		if (!NewKeyEmpty){
			I_Key = NewKeyBuf[new_key_read_i];
			INCR_NEW_KEY_I(new_key_read_i);
			if (new_key_read_i == new_key_write_i){
				NewKeyEmpty = 1;
			}
#ifdef DESKTOP
			printf("\nprocessing key %c (r=%d, w=%d, e=%d)\n",
					KEY_MAP[I_Key], new_key_read_i, new_key_write_i, NewKeyEmpty);
			printf("entry_i=%d,exp_i=%d\n", Entry_i, Exp_i );
#endif
#ifdef DEBUG_KEYS
			LCD_GoTo(1,j);
			TERMIO_PutChar(KEY_MAP[i_key]);
			j++;
			j &= 0x0f;
#endif
			//process key
			switch(KEY_MAP[I_Key]){
				//////////
				case '0': {
					if (IsShifted){
						//off
						TURN_OFF();
					} else {
						if ( EnteringExp >= ENTERING_EXP){
							if ( Exp_i == 0){
								ExpBuf[0] = 0;
								Exp_i = 1;
							} else {
								ExpBuf[1] = ExpBuf[0];
								ExpBuf[0] = 0;
								Exp_i++;
								if ( Exp_i > 2){
									Exp_i = 1;
								}
							}
						} else if (is_entering_done()){
							EnteringExp = ENTERING_SIGNIF;
							EntryBuf[Entry_i] = KEY_MAP[I_Key];
							//do not increment entry_i from 0, until first non-0 entry
						} else if ( Entry_i != 0 && Entry_i < MAX_CHARS_PER_LINE - 1 + 1){
							EntryBuf[Entry_i] = KEY_MAP[I_Key];
							Entry_i++;
						}
					}
				} break;
				//////////
				case '1': //fallthrough
				case '2': //fallthrough
				case '3': //fallthrough
				case '4': //fallthrough
				case '5': //fallthrough
				case '6': //fallthrough
				case '7': //fallthrough
				case '8': //fallthrough
				case '9': {
					if (IsShifted){
						finish_process_entry();
					} else if ( EnteringExp >= ENTERING_EXP){
						if ( Exp_i == 0){
							ExpBuf[0] = KEY_MAP[I_Key] - '0';
							Exp_i = 1;
						} else {
							ExpBuf[1] = ExpBuf[0];
							ExpBuf[0] = KEY_MAP[I_Key] - '0';
							Exp_i++;
							if ( Exp_i > 2){
								Exp_i = 1;
							}
						}
					} else if (is_entering_done()){
						EnteringExp = ENTERING_SIGNIF;
						EntryBuf[Entry_i] = KEY_MAP[I_Key];
						Entry_i++;
					} else if ( Entry_i < MAX_CHARS_PER_LINE - 1 + 1){
						EntryBuf[Entry_i] = KEY_MAP[I_Key];
						Entry_i++;
					}
				} break;
				//////////
				case '.': {
					if (IsShifted){
						//STO
						finish_process_entry();
					} else {
						if (is_entering_done()){
							EntryBuf[Entry_i++] = '0';
							EntryBuf[Entry_i++] = '.';
							EnteringExp = ENTERING_FRAC;
						} else if ( EnteringExp == ENTERING_SIGNIF){
							if ( Entry_i == 0){
								EntryBuf[Entry_i++] = '0';
							}
							EntryBuf[Entry_i++] = '.';
							EnteringExp = ENTERING_FRAC;
						} else if ( EnteringExp <= ENTERING_EXP) {
							EnteringExp++;
						} else { //entering_exp == ENTERING_EXP_NEG
							EnteringExp = ENTERING_EXP;
						}
					}
				} break;
				//////////
				case '=': {
					if (IsShifted){ //RCL
						finish_process_entry();
					} else { //Enter
						//track stack lift
						finish_process_entry();
						NoLift = 1;
					}
				} break;
				//////////
				case 'c': {
					if (IsShifted || is_entering_done()){
						//clear
						IsShifted = 0;
						NoLift = 1;
						entering_done();
						EnteringExp = ENTERING_DONE_CLEARED;
						//do not increment entry_i from 0, until first non-0 entry
					} else if ( EnteringExp >= ENTERING_EXP){
						//go back to digit entry
						EnteringExp--;
						Exp_i = 0;
						ExpBuf[0] = 0;
						ExpBuf[1] = 0;
					} else if ( Entry_i > 0){
						//backspace
						Entry_i--;
						if (EntryBuf[Entry_i] == '.'){
							EnteringExp = ENTERING_SIGNIF;
						}
					}
				} break;
				//////////
				case '+': //fallthrough
				case '*': //fallthrough
				case '-': //fallthrough
				case '/': //fallthrough
				case '<': //fallthrough //use as +/-
				case 'r': { //use as swap
					finish_process_entry();
				} break;
				//////////
				default: process_cmd(KEY_MAP[I_Key]);
				//////////
			} //switch(KEY_MAP[i_key])
		} else { //else for (if found new key pressed)
			//no new key pressed
			continue;
		}


		LCD_GoTo(0,0);
		//display y register on first line
		if (is_entering_done() || NoLift){
			disp_exponent = decn_to_str(get_y());
		} else {
			//display x on 1st line, entered number on 2nd line
			disp_exponent = decn_to_str(get_x());
		}
		if (disp_exponent == 0){
			LCD_OutString(Buf, MAX_CHARS_PER_LINE);
		} else { //have exponent to display
			LCD_OutString(Buf, MAX_CHARS_PER_LINE - 3);
			if (disp_exponent < 0){
				TERMIO_PutChar(CGRAM_EXP_NEG);
				disp_exponent = -disp_exponent;
			} else {
				TERMIO_PutChar(CGRAM_EXP);
			}
			TERMIO_PutChar((disp_exponent / 10) + '0');
			TERMIO_PutChar((disp_exponent % 10) + '0');
		}

		//print X
		LCD_ClearToEnd(0); //go to 2nd row
#ifdef DESKTOP
		print_lcd();
		printf("entry_i=%d,exp_i=%d\n", Entry_i, Exp_i );
		print_entry_bufs();
#endif
		if ( EnteringExp == ENTERING_DONE){ //does not cover cleared case
			disp_exponent = decn_to_str(get_x());
			if (disp_exponent == 0){
				LCD_OutString(Buf, MAX_CHARS_PER_LINE);
			} else { //have exponent to display
				LCD_OutString(Buf, MAX_CHARS_PER_LINE - 3);
				if (disp_exponent < 0){
					TERMIO_PutChar(CGRAM_EXP_NEG);
					disp_exponent = -disp_exponent;
				} else {
					TERMIO_PutChar(CGRAM_EXP);
				}
				TERMIO_PutChar((disp_exponent / 10) + '0');
				TERMIO_PutChar((disp_exponent % 10) + '0');
			}
		} else if ( Entry_i == 0){
			TERMIO_PutChar('0');
		} else if ( EnteringExp < ENTERING_EXP){
			uint8_t idx;
			for (idx = 0; idx < Entry_i && idx < MAX_CHARS_PER_LINE; idx++){
				TERMIO_PutChar(EntryBuf[idx]);
			}
		} else {
			uint8_t idx;
			//print significand
			for (idx = 0; idx < Entry_i && idx < MAX_CHARS_PER_LINE - 3; idx++){
				TERMIO_PutChar(EntryBuf[idx]);
			}
			//go to exponent
			if (idx < MAX_CHARS_PER_LINE - 3){
				//clear until exponent
				for ( ; idx < MAX_CHARS_PER_LINE - 3; idx++){
					TERMIO_PutChar(' ');
				}
			} else {
				LCD_GoTo(1, MAX_CHARS_PER_LINE - 3);
			}
			//print exponent sign
			if ( EnteringExp == ENTERING_EXP_NEG){
				TERMIO_PutChar(CGRAM_EXP_NEG);
			} else {
				TERMIO_PutChar(CGRAM_EXP);
			}
			//print exp
			TERMIO_PutChar(ExpBuf[1] + '0');
			TERMIO_PutChar(ExpBuf[0] + '0');
		}
		LCD_ClearToEnd(1);

		//print shifted status
		if (IsShifted){
			TERMIO_PutChar('^');
		}

#ifdef DESKTOP
		print_lcd();
		printf("entry_i=%d,exp_i=%d\n", Entry_i, Exp_i );
		print_entry_bufs();
		LcdAvailable.release();
#endif
		//turn backlight back on
		BACKLIGHT_ON();
	} //while (1)
}
/* ------------------------------------------------------------------------- */