/*------------------------------------------------------- 
 * MCR設定&周辺モジュール (PIC16F18857) 
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "mcr-motor.h"
#include "ir-frame.h"
#include "adc.h"
#include "com.h"
#include "pp-sb.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  = 0xDF; /* (RB7,RB6),RB4,(RB3),RB2,RB1,RB0 */
  TRISC  = 0x87; /* (RC7),RC2,RC1,RC0 */
  IOCBP  = 0x01; /* RB0 */
  IOCBN  = 0x01; /* RB0 */
  IOCAF  = 0x00;
  WPUA   = 0x00; 
  WPUB   = 0xC8; /* RB7,RB6,RB3 */
  WPUC   = 0x00;
  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 */
  RB1PPS = 0x14;     /* RB1 <- SCL1 */
  RB2PPS = 0x15;     /* RB2 <- SDA1 */
  SSP1CLKPPS = 0x09; /* RB1 -> SCL1 */
  SSP1DATPPS = 0x0A; /* RB2 -> SDA1 */
  PPSLOCK = 0x55;
  PPSLOCK = 0xAA;
  PPSLOCKbits.PPSLOCKED = 1;
  GIE = ogie;
  /* 周辺モジュール */
  TMR3_Init();
  ADC_Init();
  MCR_Motor_Init();
  IOCIE = 1;
}

/*--------------------------------------------*/
/* TMR3 */
/* 計時タイマとして使用 */
/* Src: FOSC/4, Prescale 1:2, タイマー周期: 16.384mSec */

void TMR3_Init(void)
{
  T3CONbits.TMR3ON = 0;
  T3CONbits.CKPS = 0x01; /* Prescale: 1:2 */
  T3CLKbits.CS   = 0x01; /* FOSC/4 */
  T3GCON = 0x00;
  TMR3H = 0;
  TMR3L = 0;
  TMR3IF = 0;
  TMR3IE = 1;
  T3CONbits.TMR3ON = 1;
}

uint16_t TMR3_Read(void)
{
  T3CONbits.TMR3ON = 0;
  uint16_t t = ((uint16_t)TMR3H << 8) | (uint16_t)TMR3L;
  TMR3H = 0;
  TMR3L = 0;
  T3CONbits.TMR3ON = 1;
  return t;
}

void TMR3_isr(void)
{
  T3CONbits.TMR3ON = 0;
  TMR3H = 0xFF;
  TMR3L = 0xFF;
}

/*--------------------------------------------*/
/* 割込ハンドラ */
__interrupt() void isr(void)
{
  /* TMR1: 低速ブースト機能用 (pp-sb.c参照) */
  if ((TMR1IE == 1) && (TMR1IF == 1)) {
    TMR1IF = 0;
    TMR1_isr();
  }
  /* TMR2: PWM周波数発生用 (割り込みハンドラなし/mcr-motor.c参照) */
  /* TMR3: テレビリモコンのパケットデコーダ用 */
  if ((TMR3IE == 1) && (TMR3IF == 1)) {
    TMR3IF = 0;
    TMR3_isr();
    ir_frame_isr(2, 0xFFFF); /* デコーダ状態遷移: リセット */
  }
  /* IOC RB0 */ 
  if ((IOCIE == 1) && (IOCIF == 1)) {
    IOCIF = 0;
    if ((IOCBF & 0x01) != 0) {
      IOCBF &= ~0x01;
      if (RB0 == 1) {
        ir_frame_isr(1, TMR3_Read()); /* デコーダ状態遷移: オン期間終了 */
      } else {
        ir_frame_isr(0, TMR3_Read()); /* デコーダ状態遷移: オフ期間終了 */
      }
    }
  } 
}

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