/*------------------------------------------------------- 
 * モータ駆動関係の周辺モジュール設定 (PIC16F18877/18857) 
 * 使用周辺モジュール: TMR2, CCP1, CWG1
 * PWM周波数: 31.25kHz
 * 出力ピン:  CWG1A, CWG1B
 * 出力形式:  Active Low
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "mcr-motor.h"

/*--------------------------------------------*/
/* MCR_Motor */
void MCR_Motor_Init(void)
{
  TMR2_Init();
  CCP1_Init(); 
  CWG1_Init();
}

/*--------------------------------------------*/
/* TMR2 */
/*   PWM周波数 = 31.25kHz  
 *      (32MHz/(31.25kHz*4*1)) - 1 = 255 = PR2
 */
void TMR2_Init(void)
{
  T2CONbits.TMR2ON = 0; /* Disabled */
  T2CONbits.T2OUTPS = 0;  /* Postscale: 1:1 */
  T2CONbits.T2CKPS  = 0;  /* Prescale:  1:1 */
  T2CLKCONbits.CS = 0x01; /* Clock: FOSC/4 */
  T2HLTbits.MODE  = 0x00; /* Software Control */
  T2PR  = 0xFF;           /* PWM周波数: 31.25kHz */
  T2TMR = 0;
  TMR2IF = 0;
}

void TMR2_Start(void)
{
  T2CONbits.TMR2ON = 1; /* Enabled */
}

/*--------------------------------------------*/
/* CCP1 */
void CCP1_Init(void)
{
  CCP1CONbits.CCP1EN   = 1;   /* Enabled */
  CCP1CONbits.CCP1FMT  = 0;   /* 右寄せ形式 */
  CCP1CONbits.CCP1MODE = 0xF; /* PWMモード */
  CCPTMRS0bits.C1TSEL  = 0x1; /* TMR2 */
  CCPR1L = 0x00;
  CCPR1H = 0x00;
}

void CCP1_SetDutyCycle(uint16_t duty)
{
  CCPR1H = duty >> 8; /* 2 MSBs */
  CCPR1L = duty;      /* 8 LSBs */
}

/*--------------------------------------------*/
/* CWG1 */
void CWG1_Init(void)
{
  CWG1CON0bits.CWG1EN = 0; /* Disabled */
  CWG1CON0bits.CWG1MODE = 0; /* ステアリングモード */
  CWG1CON1bits.POLA = 1; /* Inverted Polarity */
  CWG1CON1bits.POLB = 1; /* Inverted Polarity */
  CWG1STRbits.OVRA = 1; /* Active Low */
  CWG1STRbits.OVRB = 1; /* Active Low */
  CWG1STRbits.STRA = 0; /* Steering A (0:OVRA, 1:Inv-Data) */
  CWG1STRbits.STRB = 0; /* Steering B (0:OVRB, 1:Inv-Data) */
  CWG1CLKCON = 0; /* Clock Source: FOSC */
  CWG1ISM = 0x01; /* Data Source: CCP1 */
  CWG1CON0bits.CWG1EN = 1; /* Enabled */
}

void MotorDriver_TB6643KQ_Reset(void)
{
  /* 割り込み禁止/許可状態を保存 */ 
  int8_t ogie  = GIE;
  int8_t opeie = PEIE;
  /* 割り込み禁止 */ 
  GIE  = 0;
  PEIE = 0;
  /* IN1,IN2:=LOW,LOW */
  CWG1STRbits.OVRA = 0;
  CWG1STRbits.OVRB = 0;
  CWG1STRbits.STRA = 0;
  CWG1STRbits.STRB = 0;
  __delay_us(5); /* 1uS以上 */
  CWG1STRbits.OVRA = 1;
  CWG1STRbits.OVRB = 1;
  /* 割り込み禁止/許可状態を復元 */ 
  GIE  = ogie;
  PEIE = opeie;
}
