/* USER CODE BEGIN Header */
/**
  ******************************************************************************
  * @file           : main.c
  * @brief          : Main program body
  ******************************************************************************
  * @attention
  *
  * <h2><center>&copy; Copyright (c) 2019 STMicroelectronics.
  * All rights reserved.</center></h2>
  *
  * This software component is licensed by ST under BSD 3-Clause license,
  * the "License"; You may not use this file except in compliance with the
  * License. You may obtain a copy of the License at:
  *                        opensource.org/licenses/BSD-3-Clause
  *
  ******************************************************************************
  */
/* USER CODE END Header */
/* Includes ------------------------------------------------------------------*/
#include "main.h"
#include <stdbool.h>
#include <stdio.h>

/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */
#include "hx711.h"
#include "string.h"
/* USER CODE END Includes */

/* Private typedef -----------------------------------------------------------*/
/* USER CODE BEGIN PTD */

#define cCAL_MAX_ITEMS 10
typedef struct tCalName
{

  long lArrMinWeight[cCAL_MAX_ITEMS];
  long lArrMaxWeight[cCAL_MAX_ITEMS];
  long lArrMinADC[cCAL_MAX_ITEMS];
  long lArrMaxADC[cCAL_MAX_ITEMS];

  int iActItems;

} tCal;


/* USER CODE END PTD */

/* Private define ------------------------------------------------------------*/
/* USER CODE BEGIN PD */

/* USER CODE END PD */

/* Private macro -------------------------------------------------------------*/
/* USER CODE BEGIN PM */

/* USER CODE END PM */

/* Private variables ---------------------------------------------------------*/

tCal glb_oSensorFootV1_D1__input1 = (tCal){
 .lArrMinWeight = {    -1500/2, 0,   500/2},
 .lArrMaxWeight = {     0, 	   500/2,  	1000/2 },
 .lArrMinADC =    {  7840291,   6721626,   578760},
 .lArrMaxADC =    { 11200000, 7840291,    6721626 },

 .iActItems = 3,
};

tCal glb_oSensorFootV1_D2__input2 = (tCal){
 .lArrMinWeight = {   -1500/2, 0,       500/2  },
 .lArrMaxWeight = {    0,      500/2,		1000/2 },
 .lArrMinADC =    {    8980833, 8009575,7260217},
 .lArrMaxADC =    {   11800000 ,8980833, 8009575 },

 .iActItems = 3,
};

tCal glb_oSensorFootV2__input4 = (tCal){
 .lArrMinWeight = {   -1500,       0,      800 },
 .lArrMaxWeight = {       0,     800,     1500 },
 .lArrMinADC =    { 5300000, 8485516,  10101269 },
 .lArrMaxADC =    { 8485516, 10101269, 11650000 },

 .iActItems = 3,
};


tCal glb_oSensorR1__input6 = (tCal){
 .lArrMinWeight = {   -1000,      0    },
 .lArrMaxWeight = {       0,      1000 },
 .lArrMinADC =    { 5489320,   8462860 },
 .lArrMaxADC =    { 8462860,  11438968 },

 .iActItems = 2,
};

tCal glb_oSensorR2__input5 = (tCal){
 .lArrMinWeight = {   -1000,       0 },
 .lArrMaxWeight = {       0,    1000 },
 .lArrMinADC =    { 6988793, 8401148 },
 .lArrMaxADC =    { 8401148, 9838337 },

 .iActItems = 2,
};



UART_HandleTypeDef huart2;

/* USER CODE BEGIN PV */
volatile int mer =0;
volatile int mer_2 =0;
volatile int mer_3 =0;
volatile int mer_4 =0;
volatile int mer_5 =0;
volatile int mer_6 =0;
volatile int merAtlag =0;
/* USER CODE END PV */

/* Private function prototypes -----------------------------------------------*/
void SystemClock_Config(void);
static void MX_GPIO_Init(void);
static void MX_USART2_UART_Init(void);

int GetCalibData( int inADC, tCal * pCal, double *pWeight );

/* USER CODE BEGIN PFP */

/* USER CODE END PFP */

/* Private user code ---------------------------------------------------------*/
/* USER CODE BEGIN 0 */
bool tempVar=true;
/* USER CODE END 0 */

/**
  * @brief  The application entry point.
  * @retval int
  */
int main(void)
{
  /* USER CODE BEGIN 1 */
	  HX711 hx11;
	  hx11.gpioSck = HS711SCK_GPIO_Port;
	  hx11.gpioData = HX711OUTPUT_GPIO_Port;
	  hx11.pinSck = HS711SCK_Pin;
	  hx11.pinData = HX711OUTPUT_Pin;
	  hx11.offset = 0;
	  hx11.gain = 64;

	  HX711 hx11_2;
	  hx11_2.gpioSck = HS711SCK2_GPIO_Port;
	  hx11_2.gpioData = HX711OUTPUT2_GPIO_Port;
	  hx11_2.pinSck = HS711SCK2_Pin;
	  hx11_2.pinData = HX711OUTPUT2_Pin;
	  hx11_2.offset = 0;
	  hx11_2.gain = 64;

	  HX711 hx11_3;
	  hx11_3.gpioSck = HS711SCK3_GPIO_Port;
	  hx11_3.gpioData = HX711OUTPUT3_GPIO_Port;
	  hx11_3.pinSck = HS711SCK3_Pin;
	  hx11_3.pinData = HX711OUTPUT3_Pin;
	  hx11_3.offset = 0;
	  hx11_3.gain = 64;

	  HX711 hx11_4;
	  hx11_4.gpioSck = HS711SCK4_GPIO_Port;
	  hx11_4.gpioData = HX711OUTPUT4_GPIO_Port;
	  hx11_4.pinSck = HS711SCK4_Pin;
	  hx11_4.pinData = HX711OUTPUT4_Pin;
	  hx11_4.offset = 0;
	  hx11_4.gain = 64;

	  HX711 hx11_5;
	  hx11_5.gpioSck = HS711SCK5_GPIO_Port;
	  hx11_5.gpioData = HX711OUTPUT5_GPIO_Port;
	  hx11_5.pinSck = HS711SCK5_Pin;
	  hx11_5.pinData = HX711OUTPUT5_Pin;
	  hx11_5.offset = 0;
	  hx11_5.gain = 64;

	  HX711 hx11_6;
	  hx11_6.gpioSck = HS711SCK6_GPIO_Port;
	  hx11_6.gpioData = HX711OUTPUT6_GPIO_Port;
	  hx11_6.pinSck = HS711SCK6_Pin;
	  hx11_6.pinData = HX711OUTPUT6_Pin;
	  hx11_6.offset = 0;
	  hx11_6.gain = 64;

	  double arr_dWeight[6];
	  int iRetVal;
	  for( int iCnt = 0; iCnt < 6; iCnt++)
	  {
		  arr_dWeight[iCnt] = 0;
	  }

  /* USER CODE END 1 */

  /* MCU Configuration--------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* USER CODE BEGIN Init */

  /* USER CODE END Init */

  /* Configure the system clock */
  SystemClock_Config();

  /* USER CODE BEGIN SysInit */

  /* USER CODE END SysInit */

  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_USART2_UART_Init();
  /* USER CODE BEGIN 2 */
  HX711_Init(hx11);
 // HX711_Init(hx11_2);
 // HX711_Init(hx11_3);
 // HX711_Init(hx11_4);
 // HX711_Init(hx11_5);
 // HX711_Init(hx11_6);

   char masage[2*255];
//uint8_t times = 4;

//uint8_t times = 4;
//meresAtlag = HX711_AverageValue(hx11,  times);
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
	  mer = HX711_Value(hx11); // MERI VSTUP adc1
	  mer_2 = HX711_Value(hx11_2); // VSTUP adc2
	  mer_3 = HX711_Value(hx11_3); // ..
	  mer_4 = HX711_Value(hx11_4); // ..
	  mer_5 = HX711_Value(hx11_5);
	  mer_6 = HX711_Value(hx11_6);
	  //meres = HX711_AverageValue(hx11, times);
	  iRetVal = GetCalibData( mer, &glb_oSensorFootV1_D1__input1, &arr_dWeight[1-1]);
/*
	  HAL_UART_Transmit(&huart2, (uint8_t *)masage,
			  sprintf(masage,"D1: Input %ld : RetVal %d, weight %7.1f]\r\n",mer, iRetVal, dWeight ),1000);
*/

	  iRetVal = GetCalibData( mer_2, &glb_oSensorFootV1_D2__input2, &arr_dWeight[2-1]);
/*
	  HAL_UART_Transmit(&huart2, (uint8_t *)masage,
			  sprintf(masage, "D2: Input %ld : RetVal %d, weight %7.1f\r\n",mer_2, iRetVal, dWeight ),1000);
*/


	  iRetVal = GetCalibData( mer_4, &glb_oSensorFootV2__input4, &arr_dWeight[4-1]);
/*
	  HAL_UART_Transmit(&huart2, (uint8_t *)masage,
			  sprintf(masage, "D4: Input %ld : RetVal %d, weight %7.1f\r\n",meres_4, iRetVal, dWeight ),1000);
*/
	  iRetVal = GetCalibData( mer_5, &glb_oSensorR2__input5, &arr_dWeight[5-1]);
	  iRetVal = GetCalibData( mer_6, &glb_oSensorR1__input6, &arr_dWeight[6-1]);

	  HAL_Delay(500);
/*
	  HAL_UART_Transmit(&huart2, (uint8_t *)masage,
			  sprintf(masage,"D1 %d  D2 %d  D3 %d  D4 %d  D5 %d  D6 %d\n\r", mer, mer_2, mer_3, mer_4, mer_5, mer_6),1000);
*/

	  HAL_UART_Transmit(&huart2, (uint8_t *)masage,
			  sprintf(masage,"D1 %d D2 %d D3 %d D4 %d D5 %d D6 %d - D1 %7.1f D2 %7.1f (Fv1 %7.1f) D3 %7.1f D4 %7.1f D5 %7.1f D6 %7.1f \r\n",
					  mer, mer_2, mer_3, mer_4, mer_5, mer_6,
					  arr_dWeight[1-1], arr_dWeight[2-1], arr_dWeight[1-1]+arr_dWeight[2-1], arr_dWeight[3-1], arr_dWeight[4-1], arr_dWeight[5-1], arr_dWeight[6-1]),
					  1000);

	  //HAL_UART_Transmit(&huart2, masage, sprintf(masage, "ahoj"),1000);
    /* USER CODE END WHILE */

  }
  /* USER CODE END 3 */
}


int GetCalibData( int inADC, tCal * pCal, double *pWeight )
{
	int iCnt;

	*pWeight = -6543.21f;

	for( iCnt = 0; iCnt < pCal->iActItems; iCnt++ )
	{
		  if( (inADC>pCal->lArrMinADC[iCnt])&&(inADC<=pCal->lArrMaxADC[iCnt]) )
		  {
			  double dDiv = (pCal->lArrMaxADC[iCnt]-pCal->lArrMinADC[iCnt]);
			  if (dDiv==0) return 0;
			  //printf( " dDiv %f \n", dDiv );
			  double dTop = (pCal->lArrMaxWeight[iCnt]-pCal->lArrMinWeight[iCnt]);
			  //printf( " dTop %f \n", dTop );

			  double dA = dTop/dDiv;
			  //printf( " dA %f \n", dA );
			  double dB = pCal->lArrMinWeight[iCnt] - pCal->lArrMinADC[iCnt]*dA;
			  //printf( " dB %f \n", dB );

			  *pWeight = inADC*dA + dB;
			  return 1;
		  }
	} // end for

  return 0;
}



/**
  * @brief System Clock Configuration
  * @retval None
  */
void SystemClock_Config(void)
{
  RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

  /** Configure the main internal regulator output voltage
  */
  __HAL_RCC_PWR_CLK_ENABLE();
  __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE3);
  /** Initializes the RCC Oscillators according to the specified parameters
  * in the RCC_OscInitTypeDef structure.
  */
  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
  RCC_OscInitStruct.HSIState = RCC_HSI_ON;
  RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
  RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
  RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI;
  RCC_OscInitStruct.PLL.PLLM = 16;
  RCC_OscInitStruct.PLL.PLLN = 336;
  RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV4;
  RCC_OscInitStruct.PLL.PLLQ = 2;
  RCC_OscInitStruct.PLL.PLLR = 2;
  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  {
    Error_Handler();
  }
  /** Initializes the CPU, AHB and APB buses clocks
  */
  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
                              |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
  RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
  RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

  if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
  {
    Error_Handler();
  }
}

/**
  * @brief USART2 Initialization Function
  * @param None
  * @retval None
  */
static void MX_USART2_UART_Init(void)
{

  /* USER CODE BEGIN USART2_Init 0 */

  /* USER CODE END USART2_Init 0 */

  /* USER CODE BEGIN USART2_Init 1 */

  /* USER CODE END USART2_Init 1 */
  huart2.Instance = USART2;
  huart2.Init.BaudRate = 115200;
  huart2.Init.WordLength = UART_WORDLENGTH_8B;
  huart2.Init.StopBits = UART_STOPBITS_1;
  huart2.Init.Parity = UART_PARITY_NONE;
  huart2.Init.Mode = UART_MODE_TX_RX;
  huart2.Init.HwFlowCtl = UART_HWCONTROL_NONE;
  huart2.Init.OverSampling = UART_OVERSAMPLING_16;
  if (HAL_UART_Init(&huart2) != HAL_OK)
  {
    Error_Handler();
  }
  /* USER CODE BEGIN USART2_Init 2 */

  /* USER CODE END USART2_Init 2 */

}

/**
  * @brief GPIO Initialization Function
  * @param None
  * @retval None
  */
static void MX_GPIO_Init(void)
{
  GPIO_InitTypeDef GPIO_InitStruct = {0};

  /* GPIO Ports Clock Enable */
  __HAL_RCC_GPIOC_CLK_ENABLE();
  __HAL_RCC_GPIOH_CLK_ENABLE();
  __HAL_RCC_GPIOA_CLK_ENABLE();
  __HAL_RCC_GPIOB_CLK_ENABLE();

  /*Configure GPIO pin Output Level */
//  HAL_GPIO_WritePin(GPIOA, LD2_Pin|HX711OUTPUT6_Pin|HX711OUTPUT5_Pin|HX711OUTPUT4_Pin|HX711OUTPUT3_Pin|HX711OUTPUT2_Pin|HX711OUTPUT_Pin, GPIO_PIN_RESET);
  HAL_GPIO_WritePin(GPIOA, LD2_Pin, GPIO_PIN_RESET);

  /*Configure GPIO pin : B1_Pin */
  GPIO_InitStruct.Pin = B1_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_IT_FALLING;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  HAL_GPIO_Init(B1_GPIO_Port, &GPIO_InitStruct);

  /*Configure GPIO pins : HX711OUTPUT5_Pin HX711OUTPUT3_Pin LD2_Pin HX711OUTPUT2_Pin
                           HX711OUTPUT_Pin HX711OUTPUT4_Pin HX711OUTPUT6_Pin */
  GPIO_InitStruct.Pin = LD2_Pin|HS711SCK_Pin|HS711SCK2_Pin|HS711SCK3_Pin|HS711SCK4_Pin|HS711SCK5_Pin|HS711SCK6_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

  /*Configure GPIO pins : HS711SCK5_Pin HS711SCK3_Pin HS711SCK_Pin HS711SCK2_Pin
                           HS711SCK4_Pin HS711SCK6_Pin */
  //GPIO_InitStruct.Pin = HX711OUTPUT6_Pin|HX711OUTPUT5_Pin|HX711OUTPUT4_Pin|HX711OUTPUT3_Pin|HX711OUTPUT2_Pin|HX711OUTPUT_Pin;
  GPIO_InitStruct.Pin = HX711OUTPUT5_Pin|HX711OUTPUT4_Pin|HX711OUTPUT3_Pin|HX711OUTPUT2_Pin|HX711OUTPUT_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

  GPIO_InitStruct.Pin = HX711OUTPUT6_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);

}

/* USER CODE BEGIN 4 */

/* USER CODE END 4 */

/**
  * @brief  This function is executed in case of error occurrence.
  * @retval None
  */
void Error_Handler(void)
{
  /* USER CODE BEGIN Error_Handler_Debug */
	  /* User can add his own implementation to report the HAL error return state */
	  __disable_irq();
	  while (1)
	  {
	  }
  /* USER CODE END Error_Handler_Debug */
}

#ifdef  USE_FULL_ASSERT
/**
  * @brief  Reports the name of the source file and the source line number
  *         where the assert_param error has occurred.
  * @param  file: pointer to the source file name
  * @param  line: assert_param error line source number
  * @retval None
  */
void assert_failed(uint8_t *file, uint32_t line)
{
  /* USER CODE BEGIN 6 */
  /* User can add his own implementation to report the file name and line number,
     tex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
  /* USER CODE END 6 */
}
#endif /* USE_FULL_ASSERT */

/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/