2023-04-13 19:44:23 +08:00
|
|
|
|
#include <Arduino.h>
|
2023-04-11 19:16:14 +08:00
|
|
|
|
#include "HX711.h"
|
|
|
|
|
#include "OneButton.h"
|
2023-04-12 01:02:52 +08:00
|
|
|
|
#include "Serialcommand.h"
|
|
|
|
|
#include "config.h"
|
2023-04-13 19:44:23 +08:00
|
|
|
|
#include "led.h"
|
|
|
|
|
#include <Ticker.h> //调用Ticker.h库
|
|
|
|
|
#include <soc/rtc_cntl_reg.h>
|
2023-04-11 19:16:14 +08:00
|
|
|
|
|
|
|
|
|
// 角度传感器
|
|
|
|
|
// 收放线电机控制
|
|
|
|
|
// 控制串口直接使用Serial2,用法和Serial一样,如需要还可以用Serial1,但需要映射引脚
|
|
|
|
|
|
|
|
|
|
//---------------------------------
|
|
|
|
|
OneButton button_up(BTN_UP, true);
|
|
|
|
|
OneButton button_down(BTN_DOWN, true);
|
|
|
|
|
OneButton button_checktop(BTN_CT, true);
|
|
|
|
|
HX711 scale;
|
2023-04-12 01:02:52 +08:00
|
|
|
|
Serialcommand sercomm;
|
2023-04-13 19:44:23 +08:00
|
|
|
|
void sendinfo();
|
|
|
|
|
Ticker tksendinfo(sendinfo, 500); // 发送状态
|
|
|
|
|
|
|
|
|
|
HookStatus hookstatus=HS_Unknow;
|
2023-04-11 19:16:14 +08:00
|
|
|
|
|
|
|
|
|
void upbtn_click();
|
|
|
|
|
void downbtn_click();
|
|
|
|
|
void ctbtn_pressend();
|
|
|
|
|
void ctbtn_pressstart();
|
|
|
|
|
void led_tip(bool onled);
|
2023-04-13 19:44:23 +08:00
|
|
|
|
int get_pullweight();
|
|
|
|
|
void Task1(void *pvParameters);
|
|
|
|
|
//void Task1code( void *pvParameters );
|
2023-04-11 19:16:14 +08:00
|
|
|
|
|
2023-04-13 19:44:23 +08:00
|
|
|
|
int pullweight=0;
|
|
|
|
|
|
2023-04-11 19:16:14 +08:00
|
|
|
|
void setup()
|
|
|
|
|
{
|
2023-04-13 19:44:23 +08:00
|
|
|
|
WRITE_PERI_REG(RTC_CNTL_BROWN_OUT_REG, 0);//关闭低电压检测,避免无限重启
|
|
|
|
|
//启用Esp32双核第二个核心
|
|
|
|
|
xTaskCreatePinnedToCore(Task1, "Task1", 10000, NULL, 1, NULL, 0); //最后一个参数至关重要,决定这个任务创建在哪个核上.PRO_CPU 为 0, APP_CPU 为 1,或者 tskNO_AFFINITY 允许任务在两者上运行.
|
|
|
|
|
|
2023-04-11 19:16:14 +08:00
|
|
|
|
// 调试串口
|
|
|
|
|
Serial.begin(115200);
|
|
|
|
|
Serial.println("Starting PullupDevice...");
|
|
|
|
|
|
|
|
|
|
// 初始化按钮
|
|
|
|
|
button_up.attachClick(upbtn_click);
|
|
|
|
|
button_down.attachClick(downbtn_click);
|
|
|
|
|
button_checktop.setPressTicks(10); // 10毫秒就产生按下事件,用于顶部按钮检测
|
|
|
|
|
button_checktop.attachLongPressStart(ctbtn_pressstart); // 按下马上产生事件,
|
|
|
|
|
button_checktop.attachLongPressStop(ctbtn_pressend); // 抬起
|
2023-04-13 19:44:23 +08:00
|
|
|
|
|
2023-04-11 19:16:14 +08:00
|
|
|
|
// 关闭灯光LED
|
|
|
|
|
pinMode(LED_TIP, OUTPUT);
|
|
|
|
|
led_tip(false);
|
|
|
|
|
|
2023-04-13 19:44:23 +08:00
|
|
|
|
tksendinfo.start();
|
2023-04-11 19:16:14 +08:00
|
|
|
|
Serial.println("PullupDevice is ready!");
|
|
|
|
|
}
|
2023-04-13 19:44:23 +08:00
|
|
|
|
//在核心1上执行,重要的延迟低的
|
|
|
|
|
void loop()
|
|
|
|
|
{
|
|
|
|
|
tksendinfo.update();
|
|
|
|
|
button_checktop.tick();
|
|
|
|
|
button_down.tick();
|
|
|
|
|
button_up.tick();
|
|
|
|
|
sercomm.getcommand();
|
|
|
|
|
if (pullweight>10)
|
|
|
|
|
printf("PullWeight:%d\n",pullweight);
|
|
|
|
|
delay(10);
|
|
|
|
|
}
|
|
|
|
|
//在核心0上执行耗时长的低优先级的
|
|
|
|
|
void Task1(void *pvParameters) {
|
|
|
|
|
// 初始化称重传感器
|
|
|
|
|
scale.begin(LOADCELL_DOUT_PIN, LOADCELL_SCK_PIN);
|
|
|
|
|
scale.set_scale(516.f); // 这是缩放值,根据砝码实测
|
|
|
|
|
scale.tare(); // 重置为0
|
|
|
|
|
|
|
|
|
|
//在这里可以添加一些代码,这样的话这个任务执行时会先执行一次这里的内容(当然后面进入while循环之后不会再执行这部分了)
|
|
|
|
|
while(1)
|
|
|
|
|
{
|
|
|
|
|
pullweight=get_pullweight();
|
|
|
|
|
vTaskDelay(10);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
void sendinfo() // 每500ms发送状态信息
|
|
|
|
|
{
|
|
|
|
|
sercomm.sendinfo(hookstatus,5324,pullweight);
|
|
|
|
|
}
|
2023-04-11 19:16:14 +08:00
|
|
|
|
|
|
|
|
|
float Value;
|
|
|
|
|
#define FILTER_A 0.5
|
|
|
|
|
// 低通滤波和限幅后的拉力数值,单位:克
|
2023-04-13 19:44:23 +08:00
|
|
|
|
int get_pullweight()
|
2023-04-11 19:16:14 +08:00
|
|
|
|
{
|
|
|
|
|
float NewValue;
|
|
|
|
|
if (scale.wait_ready_timeout(100)) // 等待数据ok,100ms超时
|
|
|
|
|
NewValue = scale.get_units();
|
|
|
|
|
else
|
|
|
|
|
NewValue = 0;
|
|
|
|
|
Value = NewValue * FILTER_A + (1.0 - FILTER_A) * Value; // 低通滤波
|
|
|
|
|
Value = constrain(Value, 0.0, 6000.0); // 限制到0-6公斤
|
2023-04-13 19:44:23 +08:00
|
|
|
|
return round(Value);
|
2023-04-11 19:16:14 +08:00
|
|
|
|
}
|
|
|
|
|
// 提示灯光控制
|
|
|
|
|
void led_tip(bool onled)
|
|
|
|
|
{
|
|
|
|
|
if (onled)
|
|
|
|
|
digitalWrite(LED_TIP, LOW); // 亮灯
|
|
|
|
|
else
|
|
|
|
|
digitalWrite(LED_TIP, HIGH); // 亮灯
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void ctbtn_pressstart()
|
|
|
|
|
{
|
|
|
|
|
Serial.println("ctbtn_pressstart");
|
|
|
|
|
led_tip(true);
|
|
|
|
|
}
|
|
|
|
|
void ctbtn_pressend()
|
|
|
|
|
{
|
|
|
|
|
Serial.println("ctbtn_pressend");
|
|
|
|
|
led_tip(false);
|
|
|
|
|
}
|
|
|
|
|
void downbtn_click()
|
|
|
|
|
{
|
|
|
|
|
Serial.println("downbtn_click");
|
|
|
|
|
}
|
|
|
|
|
void upbtn_click()
|
|
|
|
|
{
|
|
|
|
|
Serial.println("upbtn_click");
|
|
|
|
|
}
|