/*------------------------------------------------------- 
 * MCR設定&周辺モジュール (PIC16F18857) 
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "mcr-motor.h"
#include "adc.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;
  ANSELA = 0xBF; /* ANA7,ANA5,ANA4,ANA3,ANA2,ANA1,(ANA0) */
  ANSELB = 0x00; /* - */
  ANSELC = 0x00; /* - */
  TRISA  = 0xFF; /* RA7,RA6,RA5,RA4,RA3,RA2,RA1,(RA0) */
  TRISB  = 0xFF; /* (RB7,RB6),RB5,RB4,RB3,RB2,RB1,RB0 */
  TRISC  = 0x87; /* (RC7),RC2,RC1,RC0 */
  WPUA   = 0x01; /* RA0 */
  WPUB   = 0xFF; /* RB7,RB6,RB5,RB4,RB3,RB2,RB1,RB0 */
  WPUC   = 0x80; /* RC7 */
  WPUE   = 0x00;
  ODCONA = 0x00;
  ODCONB = 0x00;
  ODCONC = 0x00;
  int8_t ogie = GIE;
  GIE = 0;
  PPSLOCK = 0x55;
  PPSLOCK = 0xAA;
  PPSLOCKbits.PPSLOCKED = 0;
  RC5PPS = 0x05;   /* RC5 <- CWG1A */
  RC6PPS = 0x06;   /* RC6 <- CWG1B */
  PPSLOCK = 0x55;
  PPSLOCK = 0xAA;
  PPSLOCKbits.PPSLOCKED = 1;
  GIE = ogie;
  /* 周辺モジュール */
  ADC_Init();
  MCR_Motor_Init();
}

/*--------------------------------------------*/
/* 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
