218 lines
6.3 KiB
C
218 lines
6.3 KiB
C
/* USER CODE BEGIN Header */
|
||
/**
|
||
******************************************************************************
|
||
* @file yunhorn_sts_weight_scale.c *
|
||
* @author Yunhorn (r) Technology Limited Application Team *
|
||
* @brief Yunhorn (r) SmarToilets (r) Product configuration file. *
|
||
******************************************************************************
|
||
* @attention
|
||
*
|
||
* Copyright (c) 2024 Yunhorn Technology Limited.
|
||
* Copyright (c) 2024 Shenzhen Yunhorn Technology Co., Ltd.
|
||
* All rights reserved.
|
||
*
|
||
* This software is licensed under terms that can be found in the LICENSE file
|
||
* in the root directory of this software component.
|
||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
||
*
|
||
******************************************************************************
|
||
*/
|
||
/* USER CODE END Header */
|
||
#include "sts_weight_scale.h"
|
||
|
||
uint32_t HX711_Buffer;
|
||
volatile uint32_t gross_weight;
|
||
int32_t net_weight;
|
||
uint8_t Flag_Error;
|
||
volatile uint32_t last_net_weight=0;
|
||
volatile sts_sensor_t sts_sensor_data;
|
||
void sts_weight_scale_init(void)
|
||
{
|
||
HX711_Init();
|
||
Get_GrossWeight();
|
||
HAL_Delay(100);
|
||
Get_GrossWeight();
|
||
}
|
||
|
||
void sts_weight_scale(sts_sensor_t *sts_sensor_data)
|
||
{
|
||
|
||
//while(1)
|
||
{
|
||
Get_NetWeight();
|
||
APP_LOG(TS_OFF, VLEVEL_M, "Net Weight = %d g \r\n", net_weight);
|
||
sts_sensor_data->weight_scale_value=net_weight;
|
||
|
||
last_net_weight = net_weight;
|
||
if (((last_net_weight - net_weight) > 100) && (net_weight > 100)) // re-calibrate
|
||
{
|
||
Get_GrossWeight();
|
||
HAL_Delay(100);
|
||
Get_GrossWeight();
|
||
//HAL_Delay(2000);
|
||
Get_NetWeight();
|
||
}
|
||
//HAL_Delay(2000);
|
||
|
||
}
|
||
}
|
||
|
||
/************************************************************************************
|
||
|
||
*************************************************************************************/
|
||
|
||
|
||
uint8_t Flag_Error = 0;
|
||
|
||
//校准参数
|
||
//因为不同的传感器特性曲线不是很一致，因此，每一个传感器需要矫正这里这个参数才能使测量值很准确。
|
||
//当发现测试出来的重量偏大时，增加该数值。
|
||
//如果测试出来的重量偏小时，减小改数值。
|
||
//该值可以为小数
|
||
//#define GapValue 106.5
|
||
#define GapValue 903.2 // for 1kg bar
|
||
|
||
void HX711_Init(void)
|
||
{
|
||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
||
|
||
GPIO_InitStruct.Pin = HX711_SCK_PIN;
|
||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
||
GPIO_InitStruct.Pull = GPIO_PULLUP;
|
||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
||
HAL_GPIO_Init(HX711_SCK_PORT, &GPIO_InitStruct);
|
||
|
||
//HX711_DOUT
|
||
GPIO_InitStruct.Pin = HX711_DOUT_PIN;
|
||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
||
GPIO_InitStruct.Pull = GPIO_PULLUP;
|
||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
||
HAL_GPIO_Init(HX711_DOUT_PORT, &GPIO_InitStruct);
|
||
|
||
HAL_GPIO_WritePin(HX711_SCK_PORT, HX711_SCK_PIN, GPIO_PIN_RESET);
|
||
|
||
}
|
||
|
||
//****************************************************
|
||
//读取HX711
|
||
//****************************************************
|
||
uint32_t HX711_Read(void) //增益128
|
||
{
|
||
uint32_t count;
|
||
uint8_t i;
|
||
//HX711_DOUT=1;
|
||
HAL_GPIO_WritePin(HX711_DOUT_PORT, HX711_DOUT_PIN, GPIO_PIN_SET);
|
||
|
||
delay_us(1);
|
||
//HX711_SCK=0;
|
||
HAL_GPIO_WritePin(HX711_SCK_PORT, HX711_SCK_PIN, GPIO_PIN_RESET);
|
||
|
||
count=0;
|
||
|
||
//while(HX711_DOUT);
|
||
while(HAL_GPIO_ReadPin(HX711_DOUT_PORT, HX711_DOUT_PIN)==GPIO_PIN_SET);
|
||
|
||
for(i=0;i<24;i++)
|
||
{
|
||
//HX711_SCK=1;
|
||
HAL_GPIO_WritePin(HX711_SCK_PORT, HX711_SCK_PIN, GPIO_PIN_SET);
|
||
|
||
count=count<<1;
|
||
delay_us(1);
|
||
|
||
//HX711_SCK=0;
|
||
HAL_GPIO_WritePin(HX711_SCK_PORT, HX711_SCK_PIN, GPIO_PIN_RESET);
|
||
|
||
//if(HX711_DOUT)
|
||
if (HAL_GPIO_ReadPin(HX711_DOUT_PORT, HX711_DOUT_PIN)==GPIO_PIN_SET)
|
||
count++;
|
||
|
||
delay_us(1);
|
||
}
|
||
//HX711_SCK=1;
|
||
HAL_GPIO_WritePin(HX711_SCK_PORT, HX711_SCK_PIN, GPIO_PIN_SET);
|
||
count=count^0x800000;//第25个脉冲下降沿来时，转换数据
|
||
|
||
delay_us(1);
|
||
|
||
//HX711_SCK=0;
|
||
HAL_GPIO_WritePin(HX711_SCK_PORT, HX711_SCK_PIN, GPIO_PIN_RESET);
|
||
|
||
return(count);
|
||
}
|
||
|
||
//****************************************************
|
||
//Get Gross Weight
|
||
//****************************************************
|
||
void Get_GrossWeight(void)
|
||
{
|
||
gross_weight = HX711_Read();
|
||
APP_LOG(TS_OFF, VLEVEL_M, "\r\n ##### Gross Weight =%d <<<<<< \r\n",gross_weight);
|
||
}
|
||
|
||
//****************************************************
|
||
//Weight Scale
|
||
//****************************************************
|
||
void Get_NetWeight(void)
|
||
{
|
||
HX711_Buffer = HX711_Read();
|
||
|
||
if(HX711_Buffer > gross_weight)
|
||
{
|
||
net_weight = HX711_Buffer;
|
||
net_weight = net_weight - gross_weight; //获取实物的AD采样数值。
|
||
|
||
net_weight = (int32_t)((float)net_weight/GapValue); //计算实物的实际重量
|
||
//因为不同的传感器特性曲线不一样，因此，每一个传感器需要矫正这里的GapValue这个除数。
|
||
//当发现测试出来的重量偏大时，增加该数值。
|
||
|
||
APP_LOG(TS_OFF, VLEVEL_M, "\r\n ##### Net Weight =%d \r\n", net_weight);//如果测试出来的重量偏小时，减小改数值。
|
||
}
|
||
}
|
||
|
||
|
||
//延时nus
|
||
//nus为要延时的us数.
|
||
static uint8_t fac_us=0;//us延时倍乘数
|
||
static uint16_t fac_ms=0;//ms延时倍乘数
|
||
|
||
|
||
void delay_us(uint32_t nus)
|
||
{
|
||
fac_us=SystemCoreClock/8000000; //为系统时钟的1/8
|
||
uint32_t temp;
|
||
SysTick->LOAD=nus*fac_us; //时间加载
|
||
SysTick->VAL=0x00; //清空计数器
|
||
SysTick->CTRL|=SysTick_CTRL_ENABLE_Msk ; //开始倒数
|
||
do
|
||
{
|
||
temp=SysTick->CTRL;
|
||
}
|
||
while(temp&0x01&&!(temp&(1<<16)));//等待时间到达 //bit16置一说明时间到，跳出循环
|
||
SysTick->CTRL&=~SysTick_CTRL_ENABLE_Msk; //关闭计数器
|
||
SysTick->VAL =0X00; //清空计数器
|
||
}
|
||
//延时nms
|
||
//注意nms的范围
|
||
//SysTick->LOAD为24位寄存器,所以,最大延时为:
|
||
//nms<=0xffffff*8*1000/SYSCLK
|
||
//SYSCLK单位为Hz,nms单位为ms
|
||
//对72M条件下,nms<=1864
|
||
void delay_ms(uint16_t nms)
|
||
{
|
||
fac_us=SystemCoreClock/8000000; //为系统时钟的1/8
|
||
fac_ms=(uint16_t)fac_us*1000;//非ucos下,代表每个ms需要的systick时钟数
|
||
uint32_t temp;
|
||
SysTick->LOAD=(uint32_t)nms*fac_ms;//时间加载(SysTick->LOAD为24bit)
|
||
SysTick->VAL =0x00; //清空计数器
|
||
SysTick->CTRL|=SysTick_CTRL_ENABLE_Msk ; //开始倒数
|
||
do
|
||
{
|
||
temp=SysTick->CTRL;
|
||
}
|
||
while(temp&0x01&&!(temp&(1<<16)));//等待时间到达
|
||
SysTick->CTRL&=~SysTick_CTRL_ENABLE_Msk; //关闭计数器
|
||
SysTick->VAL =0X00; //清空计数器
|
||
}
|