#include <xc.h>

#include "t6963c_specific.h"
#include "t6963c/t6963c.h"

void init_clock(void) {
	// CPDIV 1:1; RCDIV FRC/2; DOZE 1:8; G1CLKSEL disabled; DOZEN disabled; ROI disabled;
	CLKDIV = 0x3100;
	// GCLKDIV 1;
	CLKDIV2 = 0x0000;
}

void init_pins(void) {
	LATB = 0x00;
	TRISB = 0xFFFF;
	LATC = 0x00;
	TRISC = 0xF000;
	LATD = 0x00;
	TRISD = 0x0AFF;
	LATE = 0x00;
	TRISE = 0xFF;
	LATF = 0x00;
	TRISF = 0xBB;
	LATG = 0x00;
	TRISG = 0x038C;

	/****************************************************************************
	 * Setting the Analog/Digital Configuration SFR
	 ***************************************************************************/
	ANSB = 0x3F;
	ANSC = 0x6000;
	ANSD = 0xC0;
	ANSF = 0x01;
	ANSG = 0x00;

	/****************************************************************************
	 * Set the PPS
	 ***************************************************************************/
	__builtin_write_OSCCONL(OSCCON & 0xbf); // unlock PPS
	RPOR1bits.RP2R = 0x03; // RD8->UART1:U1TX
	RPINR18bits.U1RXR = 0x04; // RD9->UART1:U1RX
	RPOR1bits.RP3R = 0x04; // RD10->UART1:U1RTS
	RPINR18bits.U1CTSR = 0x0C; // RD11->UART1:U1CTS
	RPOR10bits.RP21R = 0x07; // RG6->SPI1:SDO1
	RPINR20bits.SDI1R = 0x1A; // RG7->SPI1:SDI1
	RPOR9bits.RP19R = 0x08; // RG8->SPI1:SCK1OUT
	RPOR13bits.RP27R = 0x09; // RG9->SPI1:SS1OUT
	__builtin_write_OSCCONL(OSCCON | 0x40); // lock   PPS
}

void init_lcd(void) {
	t6963c_init();
	t6963c_clear();
}

void init_uart(void) {
	// STSEL 1; IREN disabled; PDSEL 8N; UARTEN enabled; RTSMD disabled; RXINV disabled; USIDL disabled; WAKE disabled; ABAUD disabled; LPBACK disabled; BRGH enabled; UEN TX_RX;
	U1MODE = 0x8008;
	// OERR NO_ERROR_cleared; UTXISEL0 TX_ONE_CHAR; URXISEL RX_ONE_CHAR; UTXBRK COMPLETED; UTXEN disabled; ADDEN disabled; UTXINV disabled;
	U1STA = 0x0000;
	// U1TXREG 0x0000;
	U1TXREG = 0x0000;
	// U1RXREG 0x0000;
	U1RXREG = 0x0000;
	// Baud Rate = 115200; BRG 34;
	U1BRG = 0x0022;
}

void init(void) {
	init_clock();
	init_pins();
	init_lcd();
}