X-Git-Url: https://git.donarmstrong.com/?a=blobdiff_plain;f=main.c;h=3b48941dfca0ed1e647378b51b8998fa1138362c;hb=0013d7a4f31d35ad054369037e20b683085c6116;hp=ab433700966203541a1f333020783d8267388981;hpb=7230e061d7024debfe2e1ccf1053cef4af400f8c;p=kiibohd-controller.git

diff --git a/main.c b/main.c
index ab43370..3b48941 100644
--- a/main.c
+++ b/main.c
@@ -35,179 +35,41 @@
 
 
 
-// ----- Defines -----
-
-// Verified Keypress Defines
-#define USB_TRANSFER_DIVIDER 10 // 1024 == 1 Send of keypresses per second, 1 == 1 Send of keypresses per ~1 millisecond
-
-
-
-// ----- Macros -----
-#if defined(_at90usb162_) || defined(_atmega32u4_) || defined(_at90usb646_) || defined(_at90usb1286_)
-#define CPU_PRESCALE(n)	(CLKPR = 0x80, CLKPR = (n))
-#endif
-
-
-
-// ----- Variables -----
-
-// Timer Interrupt for flagging a send of the sampled key detection data to the USB host
-uint16_t sendKeypressCounter = 0;
-
-// Flag generated by the timer interrupt
-volatile uint8_t sendKeypresses = 0;
-
-
-
 // ----- Functions -----
 
-// Initial Pin Setup, make sure they are sane
-inline void pinSetup(void)
-{
-
-// AVR
-#if defined(_at90usb162_) || defined(_atmega32u4_) || defined(_at90usb646_) || defined(_at90usb1286_)
-
-	// For each pin, 0=input, 1=output
-#if defined(__AVR_AT90USB1286__)
-	DDRA = 0x00;
-#endif
-	DDRB = 0x00;
-	DDRC = 0x00;
-	DDRD = 0x00;
-	DDRE = 0x00;
-	DDRF = 0x00;
-
-
-	// Setting pins to either high or pull-up resistor
-#if defined(__AVR_AT90USB1286__)
-	PORTA = 0x00;
-#endif
-	PORTB = 0x00;
-	PORTC = 0x00;
-	PORTD = 0x00;
-	PORTE = 0x00;
-	PORTF = 0x00;
-
-// ARM
-#elif defined(_mk20dx128_)
-	// TODO - Should be cleared, but not that necessary due to the pin layout
-#endif
-}
-
-
-inline void usbTimerSetup(void)
+int main()
 {
-// AVR
+	// AVR - Teensy Set Clock speed to 16 MHz
 #if defined(_at90usb162_) || defined(_atmega32u4_) || defined(_at90usb646_) || defined(_at90usb1286_)
-
-	// Setup with 16 MHz clock
-	CPU_PRESCALE( 0 );
-
-	// Setup ISR Timer for flagging a kepress send to USB
-	// Set to 256 * 1024 (8 bit timer with Clock/1024 prescalar) timer
-	TCCR0A = 0x00;
-	TCCR0B = 0x03;
-	TIMSK0 = (1 << TOIE0);
-
-// ARM
-#elif defined(_mk20dx128_)
-	// 48 MHz clock by default
-
-	// System Clock Gating Register Disable
-	SIM_SCGC6 |= SIM_SCGC6_PIT;
-
-	// Enable Timers
-	PIT_MCR = 0x00;
-
-	// Setup ISR Timer for flagging a kepress send to USB
-	// 1 ms / (1 / 48 MHz) - 1 = 47999 cycles -> 0xBB7F
-	PIT_LDVAL0 = 0x0000BB7F;
-	PIT_TCTRL0 = 0x3; // Enable Timer 0 interrupts, and Enable Timer 0
-
-	// Insert the required vector for Timer 0
-	NVIC_ENABLE_IRQ( IRQ_PIT_CH0 );
+	CLKPR = 0x80;
+	CLKPR = 0x00;
 #endif
-}
-
-
-int main(void)
-{
-	// Configuring Pins
-	pinSetup();
-	init_errorLED();
-
-	// Setup Output Module
-	output_setup();
 
 	// Enable CLI
-	init_cli();
+	CLI_init();
 
-	// Setup ISR Timer for flagging a kepress send to USB
-	usbTimerSetup();
+	// Setup Modules
+	Output_setup();
+	Macro_setup();
+	Scan_setup();
 
 	// Main Detection Loop
-	uint8_t ledTimer = F_CPU / 1000000; // Enable LED for a short time
 	while ( 1 )
 	{
-		// Setup the scanning module
-		scan_setup();
-
-		while ( 1 )
-		{
-			// Acquire Key Indices
-			// Loop continuously until scan_loop returns 0
-			cli();
-			while ( scan_loop() );
-			sei();
-
-			// Run Macros over Key Indices and convert to USB Keys
-			process_macros();
+		// Process CLI
+		CLI_process();
 
-			// Send keypresses over USB if the ISR has signalled that it's time
-			if ( !sendKeypresses )
-				continue;
+		// Acquire Key Indices
+		// Loop continuously until scan_loop returns 0
+		cli();
+		while ( Scan_loop() );
+		sei();
 
-			// Send USB Data
-			usb_send();
+		// Run Macros over Key Indices and convert to USB Keys
+		Macro_process();
 
-			// Clear sendKeypresses Flag
-			sendKeypresses = 0;
-
-			// Indicate Error, if valid
-			errorLED( ledTimer );
-
-			if ( ledTimer > 0 )
-				ledTimer--;
-		}
-
-		// Loop should never get here (indicate error)
-		ledTimer = 255;
-
-		// HID Debug Error message
-		erro_print("Detection loop error, this is very bad...bug report!");
+		// Sends USB data only if changed
+		Output_send();
 	}
 }
 
-
-// ----- Interrupts -----
-
-// USB Keyboard Data Send Counter Interrupt
-#if defined(_at90usb162_) || defined(_atmega32u4_) || defined(_at90usb646_) || defined(_at90usb1286_) // AVR
-ISR( TIMER0_OVF_vect )
-#elif defined(_mk20dx128_) // ARM
-void pit0_isr(void)
-#endif
-{
-	sendKeypressCounter++;
-	if ( sendKeypressCounter > USB_TRANSFER_DIVIDER ) {
-		sendKeypressCounter = 0;
-		sendKeypresses = 1;
-	}
-
-#if defined(_mk20dx128_) // ARM
-	// Clear the interrupt flag
-	PIT_TFLG0 = 1;
-#endif
-}
-