void rt_hw_led_init(void)
{
	return;
}
#include <stdint.h>
#include "platform.h"

void rt_hw_led_on(int led)
{

	/*
	// Make sure the HFROSC is on before the next line:
	PRCI_REG(PRCI_HFROSCCFG) |= ROSC_EN(1);
	// Run off 16 MHz Crystal for accuracy. Note that the
	// first line is 
	PRCI_REG(PRCI_PLLCFG) = (PLL_REFSEL(1) | PLL_BYPASS(1));
	PRCI_REG(PRCI_PLLCFG) |= (PLL_SEL(1));
	// Turn off HFROSC to save power
	PRCI_REG(PRCI_HFROSCCFG) &= ~(ROSC_EN(1));
	*/


	// Wait a bit to avoid corruption on the UART.
	// (In some cases, switching to the IOF can lead
	// to output glitches, so need to let the UART
	// reciever time out and resynchronize to the real 
	// start of the stream.
	volatile int i=0;
	while(i < 10000){i++;}

	uint16_t r=0xFF;
	uint16_t g=0;
	uint16_t b=0;
	char c = 0;

	// Set up RGB PWM

	/* 
	   PWM1_REG(PWM_CFG)   = 0;
	// To balance the power consumption, make one left, one right, and one center aligned.
	PWM1_REG(PWM_CFG)   = (PWM_CFG_ENALWAYS) | (PWM_CFG_CMP2CENTER);
	PWM1_REG(PWM_COUNT) = 0;

	// Period is approximately 244 Hz
	// the LEDs are intentionally left somewhat dim, 
	// as the full brightness can be painful to look at.
	PWM1_REG(PWM_CMP0)  = 0;
	*/
	if(r > 0 && b == 0){
		r--;
		g++;
	}
	if(g > 0 && r == 0){
		g--;
		b++;
	}
	if(b > 0 && g == 0){
		r++;
		b--;
	}

	uint32_t G = g;
	uint32_t R = r;
	uint32_t B = b;

	PWM1_REG(PWM_CMP1)  = G << 4;            // PWM is low on the left, GPIO is low on the left side, LED is ON on the left.
	PWM1_REG(PWM_CMP2)  = (B << 1) << 4;     // PWM is high on the middle, GPIO is low in the middle, LED is ON in the middle.
	PWM1_REG(PWM_CMP3)  = 0xFFFF - (R << 4); // PWM is low on the left, GPIO is low on the right, LED is on on the right.
	return;
}
void rt_hw_led_off(int led)
{
	return;
}