/*------------------------------------------------------- 
 * RS232C送受信 (XON/XOFFによるフロー制御あり)
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "com.h"
#include "cons.h"

#define CHAR_XON    0x11
#define CHAR_XOFF   0x13

/* 送信バッファ */
static volatile char     com_tx_buff[COM_TX_BUFSIZ];
static volatile uint8_t  com_tx_nitems = 0;
static volatile uint8_t  com_tx_head   = 0;
static volatile uint8_t  com_tx_tail   = 0;
static volatile uint8_t  com_tx_paused = 0;
/* 受信バッファ */
static volatile char     com_rx_buff[COM_RX_BUFSIZ];
static volatile uint8_t  com_rx_nitems = 0;
static volatile uint8_t  com_rx_head   = 0;
static volatile uint8_t  com_rx_tail   = 0;
static volatile uint8_t  com_rx_paused = 0;

/* ボーレート */
enum com_baud_rate_e com_baud_rate = COM_BAUD_RATE_NULL; 

static void com_tx_put_raw(char ch);

/* 初期化 */
void com_init(void)
{
  com_tx_nitems = 0;
  com_tx_head   = 0;
  com_tx_tail   = 0;
  com_tx_paused = 0;
  com_rx_nitems = 0;
  com_rx_head   = 0;
  com_rx_tail   = 0;
  com_rx_paused = 0;
  com_tx_put(CHAR_XON);
}

/* ボーレート設定 */
void com_baud_rate_set(enum com_baud_rate_e next_baud_rate)
{
  if (com_baud_rate != next_baud_rate) {
    com_baud_rate = next_baud_rate;
    switch (com_baud_rate) {
    default:
    case COM_BAUD_RATE_NULL:
      SP1BRGH = 0x00; SP1BRGL = 0x00; break;
    case COM_BAUD_RATE_4800:  
      SP1BRGH = 0x06; SP1BRGL = 0x81; break;
    case COM_BAUD_RATE_9600:  
      SP1BRGH = 0x03; SP1BRGL = 0x40; break;
    case COM_BAUD_RATE_19200: 
      SP1BRGH = 0x01; SP1BRGL = 0xA0; break;
    case COM_BAUD_RATE_38400: 
      SP1BRGH = 0x00; SP1BRGL = 0xCF; break;
    }
  }
}

/* 送信中か */
int8_t com_tx_busy(void)
{
  int8_t nchars = 0;
  int8_t ogie  = GIE;
  int8_t opeie = PEIE;
  GIE  = 0;
  PEIE = 0;
  nchars = com_tx_nitems;
  GIE  = ogie;
  PEIE = opeie;
  return (nchars != 0);
}

/* 送信 */
void com_tx_put(char ch)
{
  int8_t ogie  = GIE;
  int8_t opeie = PEIE;
  GIE  = 0;
  PEIE = 0;
  if ((com_tx_paused == 0) &&
      (com_tx_nitems < COM_TX_BUFSIZ-2)) {
    /* XON/XOFF送信用に2文字分残しておく */
    com_tx_put_raw(ch);
  } /* 送信バッファ溢れ: 廃棄 */
  GIE  = ogie;
  PEIE = opeie;
}

/* 送信本体 (割り込み禁止状態で呼び出すこと): 
 * 送信文字を送信バッファに挿入 */
static void com_tx_put_raw(char ch)
{
  if ((ch == CHAR_XON) ||
      (ch == CHAR_XOFF)) { /* 送信文字: XON または XOFF */
    /* バッファの先頭へ挿入 */
    if (com_tx_head == 0) {
      com_tx_head = COM_TX_BUFSIZ - 1;
    } else {
      com_tx_head--;
    }
    com_tx_buff[com_tx_head] = ch;
  } else { /* 送信文字: XON/XOFF以外 (通常時) */
    /* バッファの末尾へ挿入 */
    com_tx_buff[com_tx_tail++] = ch;
    if (com_tx_tail == COM_TX_BUFSIZ) {
      com_tx_tail = 0;
    }
  }
  com_tx_nitems++;
  if (com_tx_nitems == 1) {
    TXIE = 1;
    TXIF = 1;  /* com_tx_isr()を呼び出す */
  }
}

/* 送信割込ハンドラ: 
 * 送信バッファから次の文字を取出して送信レジスタへ */
void com_tx_isr(void)
{
  if (com_tx_nitems == 0) {  /* 次の送信文字は無い */
    TXIE = 0;
  } else {                   /* 次の送信文字が有る */
    if (com_tx_paused) {  /* XOFF中 */
      TXIE = 0;
    } else {              /* XOFF中ではない(通常時) */
      com_tx_nitems--;
      TX1REG = com_tx_buff[com_tx_head++];
      if (com_tx_head == COM_TX_BUFSIZ) {
        com_tx_head = 0;
      }
    }
  }
}

/* 受信: 受信バッファに文字があるか否か */
int16_t com_rx_nchars(void)
{
  int16_t nchars = 0;
  int8_t ogie  = GIE;
  int8_t opeie = PEIE;
  GIE  = 0;
  PEIE = 0;
  nchars = (com_rx_nitems != 0);
  GIE  = ogie;
  PEIE = opeie;
  return nchars;
}

/* 受信: 受信バッファから１文字取り出して返す (なければ-1) */
/*   注意: ノンブロッキング動作 */
int16_t com_rx_get(void)
{
  int16_t ch = -1;
  int8_t ogie  = GIE;
  int8_t opeie = PEIE;
  GIE  = 0;
  PEIE = 0;
  if (com_rx_nitems == 0) { /* 受信バッファは空 */
    ch = -1;
  } else {
    com_rx_nitems--;
    ch = com_rx_buff[com_rx_head++];
    if (com_rx_head == COM_RX_BUFSIZ) {
      com_rx_head = 0;
    }
    if ((com_rx_paused != 0) && (com_rx_nitems == 0)) {
      /* 受信を再開: XON */
      com_rx_paused = 0;
      com_tx_put_raw(CHAR_XON);
    }
  }
  GIE  = ogie;
  PEIE = opeie;
  return ch;
}

/* 受信バッファの読み出し(取り出しはしない) */
int16_t com_rx_peek(void)
{
  int16_t ch = -1;
  int8_t ogie  = GIE;
  int8_t opeie = PEIE;
  GIE  = 0;
  PEIE = 0;
  if (com_rx_nitems == 0) { /* 受信バッファは空 */
    ch = -1;
  } else {
    ch = com_rx_buff[com_rx_head];
  }
  GIE  = ogie;
  PEIE = opeie;
  return ch;
}

/* 受信割込ハンドラ */
void com_rx_isr(void)
{
  /* エラー時はモジュールをリセット */
  if (RCSTAbits.OERR == 1) {
    RCSTAbits.CREN = 0;
    RCSTAbits.CREN = 1;
  }
  /* 受信文字を受信バッファへ挿入 */
  char ch = RC1REG;
  if (ch == CHAR_XOFF) {
    com_tx_paused = 1; /* 送信を一時停止 */
  } else if (ch == CHAR_XON) {
    com_tx_paused = 0; /* 送信を再開 */
    TXIE = 1;
    TXIF = 1;  /* com_tx_isr()を呼び出す */
  } else if (com_rx_nitems < COM_RX_BUFSIZ) {
    /* バッファに受信文字を収容可能 */
    com_rx_nitems++;
    com_rx_buff[com_rx_tail++] = ch;
    if (com_rx_tail == COM_RX_BUFSIZ) {
      com_rx_tail = 0;
    }
    /* XOFF送信が必要? */
    if ((com_rx_paused == 0) &&
        (com_rx_nitems == COM_RX_BUFSIZ_XOFF)) {
      /* 受信を停止: XOFF */
      com_rx_paused = 1; 
      com_tx_put_raw(CHAR_XOFF);
    }
  } else {
    /* 受信バッファ溢れ: 廃棄 */
  }
}
