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

/*--------------------------------------------*/
/* MCR初期化 (FOSC=32MHz) */
void System_Init(void)
{
  /* 発振器 */
  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;
  LATD   = 0x00;
  LATE   = 0x00;
  ANSELA = 0xFF; /* ANA7,ANA6,ANA5,ANA4,ANA3,ANA2,ANA1,ANA0 */
  ANSELB = 0x00; /* - */
  ANSELC = 0x01; /* ANC0 */
  ANSELD = 0x00; /* - */
  ANSELE = 0x00; /* - */
  TRISA  = 0xFF; /* RA7,RA6,RA5,RA4,RA3,RA2,RA1,RA0 */
  TRISB  = 0xDF; /* (RB7,RB6),RB4,RB3,RB2,RB1,RB0 */
  TRISC  = 0x3D; /* RC5,RC4,RC3,RC2,RC0 */
  TRISD  = 0xF3; /* RD7,RD6,RD5,RD4,RD1,RD0 */
  TRISE  = 0x08; /* (RE3) */
  WPUA   = 0x00;
  WPUB   = 0xC0; /* (RB7,RB6) */
  WPUC   = 0x00; /* - */
  WPUD   = 0x00; /* - */
  WPUE   = 0x08; /* (RE3) */
  ODCONA = 0x00;
  ODCONB = 0x00;
  ODCONC = 0x00;
  ODCOND = 0x00;
  ODCONE = 0x00;
  int8_t ogie = GIE;
  GIE = 0;
  PPSLOCK = 0x55;
  PPSLOCK = 0xAA;
  PPSLOCKbits.PPSLOCKED = 0;
  RC1PPS = 0x05;     /* RC1 <- CWG1A */
  RB5PPS = 0x06;     /* RB5 <- CWG1B */
  RC4PPS = 0x15;     /* RC4 <- SDA1  */
  RC5PPS = 0x14;     /* RC5 <- SCL1  */
  SSP1DATPPS = 0x14; /* RC4 -> SDA1  */
  SSP1CLKPPS = 0x15; /* RC5 -> SCL1  */
  PPSLOCK = 0x55;
  PPSLOCK = 0xAA;
  PPSLOCKbits.PPSLOCKED = 1;
  GIE = ogie;
  /* 周辺モジュール */
  ADC_Init();
  I2C_Init(I2C_BAUD_RATE_SSPxADD_1MHZ(_XTAL_FREQ));
  MCR_Motor_Init();
}

/*--------------------------------------------*/
/* 割込ハンドラ */
__interrupt() void isr(void)
{
  if ((TMR1IE != 0) && (TMR1IF != 0)) {
    extern void TMR1_isr(void);
    TMR1IF = 0;
    TMR1_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
