#include "p33Fxxxx.h"

// Select Internal FRC at POR
_FOSCSEL(FNOSC_FRC);
// Enable Clock Switching and Configure
_FOSC(FCKSM_CSECMD & OSCIOFNC_OFF);

void delay(unsigned int t) 
{
	unsigned int x;
	unsigned int i;
	for(i=0;i<650;i++)
		for(x=0;x<t;x++);
}

void initPLL(void)
{
// Configure PLL prescaler, PLL postscaler, PLL divisor
	PLLFBD = 41; 		// M = 43 FRC
	//PLLFBD = 30; 		// M = 32 XT
	CLKDIVbits.PLLPRE=0;	// N1 = 2
	CLKDIVbits.PLLPOST=0; 	// N2 = 2
	 	

// Initiate Clock Switch to Internal FRC with PLL (NOSC = 0b001)
	__builtin_write_OSCCONH(0x01);	// FRC
	//__builtin_write_OSCCONH(0x03);	// XT
	__builtin_write_OSCCONL(0x01);

// Wait for Clock switch to occur
	while (OSCCONbits.COSC != 0b001);	// FRC
	//while (OSCCONbits.COSC != 0b011);	// XT

// Wait for PLL to lock
	while(OSCCONbits.LOCK!=1) {};
}

int main(void)
{
	initPLL();		// programeaza modulul PLL
	
    TRISB = 0x0000;	/*setarea pinilor portului B ca iesiri*/
    PORTB = 0x0000;	
	
	while(1)
	{
		PORTB=0x7000;
		delay(615);
		PORTB=0xB000;
		delay(615);
		PORTB=0xD000;
		delay(615);
		PORTB=0xE000;
		delay(615);
	}
return 0;
}