#include <p33FJ128MC710.h>
#include "QEI.h"
void OscConfig(void);
void InitIOPort(void);
/*********************************************************************************
Configuration bits:
_FOSCSEL: Start up with the FRC oscillator
_FOSC: Use Primary oscillator XT with PLL, clock switching enabled
_FWDT: Watch dog timer is off
_FPOR: Power-on Reset Value disabled, Alternate I2C pins mapped to SDA1/SCL1
_FICD: JTAG is disabled, communicate on PGC2/EMUC2 and PGD2/EMUD2 for this board
**********************************************************************************/
_FOSCSEL(FNOSC_FRC)
_FOSC(FCKSM_CSECMD & OSCIOFNC_OFF & POSCMD_XT)
_FWDT(FWDTEN_OFF)
_FPOR(FPWRT_PWR1)
_FICD(JTAGEN_OFF & ICS_PGD2)
int main ( void )
{
/* Configure Oscillator Clock Source */
OscConfig();
/* initialise other modules */
InitIOPort();
init_QEI();
while(1) ;
}
void OscConfig(void){
/* Configure Oscillator to operate the device at 40MIPS
Fosc= Fin*M/(N1*N2), Fcy=Fosc/2
Fosc= 8M*40/(2*2)=80Mhz for 8M input clock */
PLLFBD=38; /* M=40 */
CLKDIVbits.PLLPOST=0; /* N1=2 */
CLKDIVbits.PLLPRE=0; /* N2=2 */
OSCTUN=0; /* Tune FRC oscillator, if FRC is used */
/* Disable Watch Dog Timer */
RCONbits.SWDTEN=0;
/* Clock switch to incorporate PLL*/
__builtin_write_OSCCONH(0x03); // Initiate Clock Switch to Primary
// Oscillator with PLL (NOSC=0b011)
__builtin_write_OSCCONL(0x01); // Start clock switching
while (OSCCONbits.COSC != 0b011); // Wait for Clock switch to occur
/* Wait for PLL to lock */
while(OSCCONbits.LOCK!=1) {};
}//end
void InitIOPort(void)
{
AD1PCFGH = 0xFFFF;
AD1PCFGL = 0xFFFF;
}//end
