/*------------------------------------------------------- 
 * MCR設定&周辺モジュール (PIC16F18857) 
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "adc.h"
#include "speed-timer.h"

/*--------------------------------------------*/
/* MCR初期化 */
void System_Init(void)
{
  /* 発振器 (FOSC=32MHz) */
  OSCCON1 = 0x10; /* HFINTOSC with 2x PLL */
  OSCCON3 = 0x00;
  OSCEN   = 0x00;
  OSCFRQ  = 0x05; /* 16MHz */
  OSCTUNE = 0x00;
  while (PLLR == 0) {
    ;
  }
  /* I/Oピン */
  LATA   = 0x00;
  LATB   = 0x00;
  LATC   = 0x00;
  TRISA  = 0xFF; /* (RA7,RA6),RA5,RA4,RA3,RA2,RA1,RA0 */
  TRISB  = 0xF8; /* (RB7,RB6),RB5,RB4,RB3 */
  TRISC  = 0x00; /* - */
  ANSELA = 0x01; /* ANA0 */
  ANSELB = 0x00;
  ANSELC = 0x00;
  WPUA   = 0xC0; /* (RA7,RA6) */ 
  WPUB   = 0xC0; /* (RB7,RB6) */
  WPUC   = 0x00;
  ODCONA = 0x00;
  ODCONB = 0x00;
  ODCONC = 0x00;
  /* 周辺モジュール */
  TMR4_Init();
  ADC_Init();
}

/*--------------------------------------------*/
/* TMR4 */
/* 計時タイマとして使用: 1周期 2.048[mSec] 
 *   256 * 32MHz / (4 * 16 * 4) 
 *   = 2.048 [mSec] 
 */
void TMR4_Init(void)
{
  T4CONbits.TMR4ON = 0; /* Disabled */
  T4CONbits.T4CKPS  = 0x2; /* Prescaler:  1:4  */
  T4CONbits.T4OUTPS = 0xF; /* Postscaler: 1:16 */
  T4CLKCONbits.CS = 1;     /* Clock: FOSC/4 */
  PR4 = 0xFF;
  TMR4 = 0x00;
  TMR4IF = 0;
  TMR4IE = 1;
}

void TMR4_Start(void)
{
  T4CONbits.TMR4ON = 1; /* Enabled */
}

void TMR4_Stop(void)
{
  T4CONbits.TMR4ON = 0; /* Disabled */
}

void TMR4_Write(uint8_t t)
{
  TMR4 = t;
}

uint8_t TMR4_Read(void)
{
  return TMR4;
}

void TMR4_isr(void)
{
  speed_timer_isr();
}

/*--------------------------------------------*/
/* 割り込みハンドラ */
__interrupt() void isr(void)
{
  if ((TMR1IE == 1) && (TMR1IF == 1)) {
    extern void TMR1_isr(void);
    TMR1IF = 0;
    TMR1_isr();
  }
  if ((TMR4IE == 1) && (TMR4IF == 1)) {
    extern void TMR4_isr(void);
    TMR4IF = 0;
    TMR4_isr();
  }
}

/*--------------------------------------------*/
/* CONFIG1 */
#pragma config FEXTOSC  = OFF
#pragma config RSTOSC   = HFINTPLL
#pragma config CLKOUTEN = OFF
#pragma config CSWEN    = ON 
#pragma config FCMEN    = ON 
/* CONFIG2 */
#pragma config MCLRE    = OFF /* MCLRをI/Oピン */
#pragma config PWRTE    = OFF
#pragma config LPBOREN  = OFF
#pragma config BOREN    = ON
#pragma config BORV     = LO
#pragma config ZCD      = OFF
#pragma config PPS1WAY  = ON
#pragma config STVREN   = ON
#pragma config DEBUG    = OFF
/* CONFIG3 */
#pragma config WDTCPS   = WDTCPS_31
#pragma config WDTE     = ON  /* WDT有効, SWDTEN無視 */
#pragma config WDTCWS   = WDTCWS_7
#pragma config WDTCCS   = SC
/* CONFIG4 */
#pragma config WRT      = OFF
#pragma config SCANE    = available
#pragma config LVP      = OFF /* 低電圧書込不可 */
/* CONFIG5 */
#pragma config CP       = OFF
#pragma config CPD      = OFF
