/*
 * FreeModbus Libary: RT-Thread Port
 * Copyright (C) 2013 Armink <armink.ztl@gmail.com>
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 * File: $Id: porttimer_m.c,v 1.60 2013/08/13 15:07:05 Armink add Master
 * Functions$
 */

/* ----------------------- Platform includes --------------------------------*/
#include "port.h"

/* ----------------------- Modbus includes ----------------------------------*/
#include "mb.h"
#include "mb_m.h"
#include "mbport.h"
#if MB_MASTER_RTU_ENABLED > 0 || MB_MASTER_ASCII_ENABLED > 0
/* ----------------------- Variables ----------------------------------------*/
static USHORT usT35TimeOut50us;
static TimerHandle_t timer = NULL;
static void prvvTIMERExpiredISR(void);
static void timer_timeout_ind(TimerHandle_t xTimer);
static BaseType_t  pxHigherPriorityTaskWoken;
/* ----------------------- static functions ---------------------------------*/
static void prvvTIMERExpiredISR(void);
/* ----------------------- Start implementation -----------------------------*/
BOOL xMBMasterPortTimersInit(USHORT usTimeOut50us) {
  /* backup T35 ticks */
  usT35TimeOut50us = usTimeOut50us;
  timer = xTimerCreate(
      "Master timer",
      (50 * usT35TimeOut50us) / (1000 * 1000 / configTICK_RATE_HZ) + 1, pdFALSE,
      (void *)1, timer_timeout_ind);
  if (timer != NULL) {
    MODBUS_DEBUG(" Create Master Timer Success!\r\n");
     return TRUE;
  } else {
    MODBUS_DEBUG(" Create Master Timer Faild!\r\n");
    return FALSE;
  }
 
}

void vMBMasterPortTimersT35Enable() {
  // MODBUS_DEBUG("Start master timer!\r\n");
     uint32_t timer_tick =
      (50 * usT35TimeOut50us) / (1000 * 1000 / configTICK_RATE_HZ) + 1;
 //printf("Set Timre=%d ms\r\n", timer_tick);
  /* Set current timer mode, don't change it.*/
  vMBMasterSetCurTimerMode(MB_TMODE_T35);
  if (IS_IRQ()) {
    xTimerChangePeriodFromISR((TimerHandle_t)timer, timer_tick, &pxHigherPriorityTaskWoken);
  } else {
    xTimerChangePeriod((TimerHandle_t)timer, timer_tick, 0);
  }
}

void vMBMasterPortTimersConvertDelayEnable() {
  
   uint32_t timer_tick =
      MB_MASTER_DELAY_MS_CONVERT * configTICK_RATE_HZ / 1000;
  //printf("Set Timre=%d ms\r\n", timer_tick);
  /* Set current timer mode, don't change it.*/
  vMBMasterSetCurTimerMode(MB_TMODE_CONVERT_DELAY);
  if (IS_IRQ()) {
    xTimerChangePeriodFromISR((TimerHandle_t)timer, timer_tick, &pxHigherPriorityTaskWoken);
  } else {
    xTimerChangePeriod((TimerHandle_t)timer, timer_tick, 0);
  }
}

void vMBMasterPortTimersRespondTimeoutEnable() {
   uint32_t timer_tick =
      MB_MASTER_TIMEOUT_MS_RESPOND * configTICK_RATE_HZ / 1000;
  //printf("Set %d\r\n", timer_tick);
  /* Set current timer mode, don't change it.*/
  vMBMasterSetCurTimerMode(MB_TMODE_RESPOND_TIMEOUT);
  if (IS_IRQ()) {
    xTimerChangePeriodFromISR((TimerHandle_t)timer, timer_tick, &pxHigherPriorityTaskWoken);
  } else {
    xTimerChangePeriod((TimerHandle_t)timer, timer_tick, 0);
  }
}

void vMBMasterPortTimersDisable() {
  // MODBUS_DEBUG("Stop master timer!\r\n");
  //printf("STop!\r\n");
  if (IS_IRQ()) {
    xTimerStopFromISR((TimerHandle_t)timer, 0);
  } else {
    xTimerStop((TimerHandle_t)timer, 0);
  }
}

void prvvTIMERExpiredISR(void) { (void)pxMBMasterPortCBTimerExpired(); }

static void timer_timeout_ind(xTimerHandle xTimer) {
  // MODBUS_DEBUG(" Master Timer callback!\r\n");
  //printf("%.2f ms\r\n",(float)__HAL_TIM_GetCounter(&htim7)/100.f);
  prvvTIMERExpiredISR();
  
}

#endif