Merge branch 'master' of http://git.brisky.space:441/btl143/firmware_clover
This commit is contained in:
@@ -1,5 +1,5 @@
|
|||||||
{
|
{
|
||||||
"name": "violet_firmware_zf",
|
"name": "firmware_clover",
|
||||||
"type": "RISC-V",
|
"type": "RISC-V",
|
||||||
"dependenceList": [],
|
"dependenceList": [],
|
||||||
"srcDirs": [
|
"srcDirs": [
|
||||||
@@ -8,7 +8,8 @@
|
|||||||
"libraries/zf_common",
|
"libraries/zf_common",
|
||||||
"libraries/zf_device",
|
"libraries/zf_device",
|
||||||
"libraries/zf_driver",
|
"libraries/zf_driver",
|
||||||
"3rd-lib/PID-Library"
|
"3rd-lib/crc16",
|
||||||
|
"3rd-lib/lwrb"
|
||||||
],
|
],
|
||||||
"virtualFolder": {
|
"virtualFolder": {
|
||||||
"name": "<virtual_root>",
|
"name": "<virtual_root>",
|
||||||
@@ -56,7 +57,11 @@
|
|||||||
"libraries/sdk/Core",
|
"libraries/sdk/Core",
|
||||||
"libraries/zf_common",
|
"libraries/zf_common",
|
||||||
"libraries/zf_device",
|
"libraries/zf_device",
|
||||||
"libraries/zf_driver"
|
"libraries/zf_driver",
|
||||||
|
"3rd-lib/crc16",
|
||||||
|
"app/page",
|
||||||
|
"3rd-lib/lwrb/inc",
|
||||||
|
"app/tiny_frame"
|
||||||
],
|
],
|
||||||
"libList": [
|
"libList": [
|
||||||
"libraries/zf_device"
|
"libraries/zf_device"
|
||||||
|
|||||||
2
.vscode/launch.json
vendored
2
.vscode/launch.json
vendored
@@ -7,7 +7,7 @@
|
|||||||
"request": "launch",
|
"request": "launch",
|
||||||
"name": "openocd",
|
"name": "openocd",
|
||||||
"servertype": "openocd",
|
"servertype": "openocd",
|
||||||
"executable": "build\\Debug\\violet_firmware_zf.elf",
|
"executable": "build\\Debug\\firmware_clover.elf",
|
||||||
"runToEntryPoint": "main",
|
"runToEntryPoint": "main",
|
||||||
"configFiles": [
|
"configFiles": [
|
||||||
"${workspaceFolder}/tools/wch-riscv.cfg"
|
"${workspaceFolder}/tools/wch-riscv.cfg"
|
||||||
|
|||||||
28
.vscode/tasks.json
vendored
Normal file
28
.vscode/tasks.json
vendored
Normal file
@@ -0,0 +1,28 @@
|
|||||||
|
{
|
||||||
|
"tasks": [
|
||||||
|
{
|
||||||
|
"type": "cppbuild",
|
||||||
|
"label": "C/C++: gcc.exe 生成活动文件",
|
||||||
|
"command": "D:\\MinGW\\bin\\gcc.exe",
|
||||||
|
"args": [
|
||||||
|
"-fdiagnostics-color=always",
|
||||||
|
"-g",
|
||||||
|
"${file}",
|
||||||
|
"-o",
|
||||||
|
"${fileDirname}\\${fileBasenameNoExtension}.exe"
|
||||||
|
],
|
||||||
|
"options": {
|
||||||
|
"cwd": "${fileDirname}"
|
||||||
|
},
|
||||||
|
"problemMatcher": [
|
||||||
|
"$gcc"
|
||||||
|
],
|
||||||
|
"group": {
|
||||||
|
"kind": "build",
|
||||||
|
"isDefault": true
|
||||||
|
},
|
||||||
|
"detail": "调试器生成的任务。"
|
||||||
|
}
|
||||||
|
],
|
||||||
|
"version": "2.0.0"
|
||||||
|
}
|
||||||
137
3rd-lib/crc16/crc16.c
Normal file
137
3rd-lib/crc16/crc16.c
Normal file
@@ -0,0 +1,137 @@
|
|||||||
|
|
||||||
|
#include "crc16.h"
|
||||||
|
|
||||||
|
//ModBUS CRC-16 码（modbus）校验
|
||||||
|
|
||||||
|
/*
|
||||||
|
1、实时计算 CRC16
|
||||||
|
该种方式耗时比较多，但占用 FLASH、RAM 小
|
||||||
|
|
||||||
|
1）CRC 寄存器初始值为 FFFF；即 16 个字节全为 1；
|
||||||
|
2）CRC-16 / MODBUS 的多项式 A001H (1010 0000 0000 0001B) ‘H’表示 16 进制数，‘B’表示二进制数
|
||||||
|
|
||||||
|
计算步骤为：
|
||||||
|
(1).预置 16 位寄存器为十六进制 FFFF（即全为 1） ，称此寄存器为 CRC 寄存器；
|
||||||
|
(2).把第一个 8 位数据与 16 位 CRC 寄存器的低位相异或，把结果放于 CRC 寄存器；
|
||||||
|
(3).检测相异或后的 CRC 寄存器的最低位，若最低位为 1：CRC 寄存器先右移 1 位，再与多项式 A001H 进行异或；若为 0，则 CRC 寄存器右移 1 位，无需与多项式进行异或。
|
||||||
|
(4).重复步骤 3，直到右移 8 次，这样整个 8 位数据全部进行了处理；
|
||||||
|
(5).重复步骤 2 到步骤 4，进行下一个 8 位数据的处理；
|
||||||
|
(6).最后得到的 CRC 寄存器即为 CRC 码。
|
||||||
|
|
||||||
|
addr：需要校验的字节数组
|
||||||
|
num：需要校验的字节数
|
||||||
|
返回值：16 位的 CRC 校验码
|
||||||
|
*/
|
||||||
|
uint16_t crc16(uint8_t *addr,uint32_t num)
|
||||||
|
{
|
||||||
|
int i,j,temp;
|
||||||
|
uint16_t crc=0xFFFF;
|
||||||
|
for(i=0;i<num;i++)
|
||||||
|
{
|
||||||
|
crc=crc^(*addr);
|
||||||
|
for(j=0;j<8;j++)
|
||||||
|
{
|
||||||
|
temp=crc&0x0001;
|
||||||
|
crc=crc>>1;
|
||||||
|
if(temp)
|
||||||
|
{
|
||||||
|
crc=crc^0xA001;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
addr++;
|
||||||
|
}
|
||||||
|
return crc;
|
||||||
|
|
||||||
|
//将 CRC 校验的高低位对换位置
|
||||||
|
// uint16_t crc1;
|
||||||
|
// crc1 = crc >> 8;
|
||||||
|
// crc1 = crc1 | (crc << 8);
|
||||||
|
// return crc1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
2、查表计算 CRC16（耗时少）
|
||||||
|
从上面代码中，可以看出 CRC-16 的漏洞。无非是将待计算的数组，从头到尾单个字节按照同一算法反复计算。每个元素只有 0~255 的输入可能性，算法固定，所以算出来的值也是固定的。
|
||||||
|
于是可以提前计算出校验值，按照输入为 0~255，排列为一组校验输出表。计算过程中根据输入数据进行查表，从头查到尾得到最终校验值。
|
||||||
|
这样的计算方式省去了单片机的反复计算，极大缩短了计算耗时。而且可以将查表的数组类型定义为 const，存放在 Flash 中，运行时不占用 RAM。虽然都是空间换时间的策略，但这种方式只占用 Flash 不占用珍贵的 RAM。
|
||||||
|
|
||||||
|
addr：需要校验的字节数组
|
||||||
|
num：需要校验的字节数
|
||||||
|
返回值：16 位的 CRC 校验码
|
||||||
|
说 明：计算结果是高位在前，需要转换才能发送
|
||||||
|
*/
|
||||||
|
uint16_t crc16_check(uint8_t* addr, uint32_t num)
|
||||||
|
{
|
||||||
|
// CRC 高位字节值表
|
||||||
|
static const uint8_t auchCRCHi[] =
|
||||||
|
{
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
|
||||||
|
0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
|
||||||
|
0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
|
||||||
|
0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
|
||||||
|
0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
|
||||||
|
0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
||||||
|
0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
|
||||||
|
0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
|
||||||
|
0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
||||||
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
|
||||||
|
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40
|
||||||
|
} ;
|
||||||
|
// CRC 低位字节值表
|
||||||
|
static const uint8_t auchCRCLo[] =
|
||||||
|
{
|
||||||
|
0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06,
|
||||||
|
0x07, 0xC7, 0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD,
|
||||||
|
0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09,
|
||||||
|
0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A,
|
||||||
|
0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC, 0x14, 0xD4,
|
||||||
|
0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3,
|
||||||
|
0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3,
|
||||||
|
0xF2, 0x32, 0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4,
|
||||||
|
0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A,
|
||||||
|
0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29,
|
||||||
|
0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E, 0x2F, 0xEF, 0x2D, 0xED,
|
||||||
|
0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26,
|
||||||
|
0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60,
|
||||||
|
0x61, 0xA1, 0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67,
|
||||||
|
0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F,
|
||||||
|
0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68,
|
||||||
|
0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA, 0xBE, 0x7E,
|
||||||
|
0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5,
|
||||||
|
0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71,
|
||||||
|
0x70, 0xB0, 0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92,
|
||||||
|
0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C,
|
||||||
|
0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B,
|
||||||
|
0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89, 0x4B, 0x8B,
|
||||||
|
0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C,
|
||||||
|
0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42,
|
||||||
|
0x43, 0x83, 0x41, 0x81, 0x80, 0x40
|
||||||
|
};
|
||||||
|
|
||||||
|
uint8_t uchCRCHi = 0xFF;
|
||||||
|
uint8_t uchCRCLo = 0xFF;
|
||||||
|
uint16_t uIndex;
|
||||||
|
while(num--)
|
||||||
|
{
|
||||||
|
uIndex = uchCRCLo ^ *addr++;
|
||||||
|
uchCRCLo = uchCRCHi^auchCRCHi[uIndex];
|
||||||
|
uchCRCHi = auchCRCLo[uIndex];
|
||||||
|
}
|
||||||
|
return (uchCRCHi<<8|uchCRCLo);
|
||||||
|
|
||||||
|
}
|
||||||
9
3rd-lib/crc16/crc16.h
Normal file
9
3rd-lib/crc16/crc16.h
Normal file
@@ -0,0 +1,9 @@
|
|||||||
|
#ifndef __CRC_16_H
|
||||||
|
#define __CRC_16_H
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
extern uint16_t crc16(uint8_t *addr,uint32_t num); // 实时计算方式
|
||||||
|
extern uint16_t crc16_check(uint8_t* addr, uint32_t num); // 查表计算方式
|
||||||
|
|
||||||
|
#endif
|
||||||
149
3rd-lib/lwrb/inc/lwrb.h
Normal file
149
3rd-lib/lwrb/inc/lwrb.h
Normal file
@@ -0,0 +1,149 @@
|
|||||||
|
/**
|
||||||
|
* \file lwrb.h
|
||||||
|
* \brief LwRB - Lightweight ring buffer
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2023 Tilen MAJERLE
|
||||||
|
*
|
||||||
|
* Permission is hereby granted, free of charge, to any person
|
||||||
|
* obtaining a copy of this software and associated documentation
|
||||||
|
* files (the "Software"), to deal in the Software without restriction,
|
||||||
|
* including without limitation the rights to use, copy, modify, merge,
|
||||||
|
* publish, distribute, sublicense, and/or sell copies of the Software,
|
||||||
|
* and to permit persons to whom the Software is furnished to do so,
|
||||||
|
* subject to the following conditions:
|
||||||
|
*
|
||||||
|
* The above copyright notice and this permission notice shall be
|
||||||
|
* included in all copies or substantial portions of the Software.
|
||||||
|
*
|
||||||
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||||
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
|
||||||
|
* OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
|
||||||
|
* HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
|
||||||
|
* WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
||||||
|
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
|
||||||
|
* OTHER DEALINGS IN THE SOFTWARE.
|
||||||
|
*
|
||||||
|
* This file is part of LwRB - Lightweight ring buffer library.
|
||||||
|
*
|
||||||
|
* Author: Tilen MAJERLE <tilen@majerle.eu>
|
||||||
|
* Version: v3.0.0-rc1
|
||||||
|
*/
|
||||||
|
#ifndef LWRB_HDR_H
|
||||||
|
#define LWRB_HDR_H
|
||||||
|
|
||||||
|
#include <stddef.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif /* __cplusplus */
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \defgroup LWRB Lightweight ring buffer manager
|
||||||
|
* \brief Lightweight ring buffer manager
|
||||||
|
* \{
|
||||||
|
*/
|
||||||
|
|
||||||
|
#if !defined(LWRB_DISABLE_ATOMIC) || __DOXYGEN__
|
||||||
|
#include <stdatomic.h>
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Atomic type for size variable.
|
||||||
|
* Default value is set to be `unsigned 32-bits` type
|
||||||
|
*/
|
||||||
|
typedef atomic_ulong lwrb_sz_atomic_t;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Size variable for all library operations.
|
||||||
|
* Default value is set to be `unsigned 32-bits` type
|
||||||
|
*/
|
||||||
|
typedef unsigned long lwrb_sz_t;
|
||||||
|
#else
|
||||||
|
typedef unsigned long lwrb_sz_atomic_t;
|
||||||
|
typedef unsigned long lwrb_sz_t;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Event type for buffer operations
|
||||||
|
*/
|
||||||
|
typedef enum {
|
||||||
|
LWRB_EVT_READ, /*!< Read event */
|
||||||
|
LWRB_EVT_WRITE, /*!< Write event */
|
||||||
|
LWRB_EVT_RESET, /*!< Reset event */
|
||||||
|
} lwrb_evt_type_t;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Buffer structure forward declaration
|
||||||
|
*/
|
||||||
|
struct lwrb;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Event callback function type
|
||||||
|
* \param[in] buff: Buffer handle for event
|
||||||
|
* \param[in] evt: Event type
|
||||||
|
* \param[in] bp: Number of bytes written or read (when used), depends on event type
|
||||||
|
*/
|
||||||
|
typedef void (*lwrb_evt_fn)(struct lwrb* buff, lwrb_evt_type_t evt, lwrb_sz_t bp);
|
||||||
|
|
||||||
|
/* List of flags */
|
||||||
|
#define LWRB_FLAG_READ_ALL ((uint16_t)0x0001)
|
||||||
|
#define LWRB_FLAG_WRITE_ALL ((uint16_t)0x0001)
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Buffer structure
|
||||||
|
*/
|
||||||
|
typedef struct lwrb {
|
||||||
|
uint8_t* buff; /*!< Pointer to buffer data. Buffer is considered initialized when `buff != NULL` and `size > 0` */
|
||||||
|
lwrb_sz_t size; /*!< Size of buffer data. Size of actual buffer is `1` byte less than value holds */
|
||||||
|
lwrb_sz_atomic_t r; /*!< Next read pointer. Buffer is considered empty when `r == w` and full when `w == r - 1` */
|
||||||
|
lwrb_sz_atomic_t w; /*!< Next write pointer. Buffer is considered empty when `r == w` and full when `w == r - 1` */
|
||||||
|
lwrb_evt_fn evt_fn; /*!< Pointer to event callback function */
|
||||||
|
} lwrb_t;
|
||||||
|
|
||||||
|
uint8_t lwrb_init(lwrb_t* buff, void* buffdata, lwrb_sz_t size);
|
||||||
|
uint8_t lwrb_is_ready(lwrb_t* buff);
|
||||||
|
void lwrb_free(lwrb_t* buff);
|
||||||
|
void lwrb_reset(lwrb_t* buff);
|
||||||
|
void lwrb_set_evt_fn(lwrb_t* buff, lwrb_evt_fn fn);
|
||||||
|
|
||||||
|
/* Read/Write functions */
|
||||||
|
lwrb_sz_t lwrb_write(lwrb_t* buff, const void* data, lwrb_sz_t btw);
|
||||||
|
lwrb_sz_t lwrb_read(lwrb_t* buff, void* data, lwrb_sz_t btr);
|
||||||
|
lwrb_sz_t lwrb_peek(const lwrb_t* buff, lwrb_sz_t skip_count, void* data, lwrb_sz_t btp);
|
||||||
|
|
||||||
|
/* Extended read/write functions */
|
||||||
|
uint8_t lwrb_write_ex(lwrb_t* buff, const void* data, lwrb_sz_t btw, lwrb_sz_t* bw, uint16_t flags);
|
||||||
|
uint8_t lwrb_read_ex(lwrb_t* buff, void* data, lwrb_sz_t btr, lwrb_sz_t* br, uint16_t flags);
|
||||||
|
|
||||||
|
/* Buffer size information */
|
||||||
|
lwrb_sz_t lwrb_get_free(const lwrb_t* buff);
|
||||||
|
lwrb_sz_t lwrb_get_full(const lwrb_t* buff);
|
||||||
|
|
||||||
|
/* Read data block management */
|
||||||
|
void* lwrb_get_linear_block_read_address(const lwrb_t* buff);
|
||||||
|
lwrb_sz_t lwrb_get_linear_block_read_length(const lwrb_t* buff);
|
||||||
|
lwrb_sz_t lwrb_skip(lwrb_t* buff, lwrb_sz_t len);
|
||||||
|
|
||||||
|
/* Write data block management */
|
||||||
|
void* lwrb_get_linear_block_write_address(const lwrb_t* buff);
|
||||||
|
lwrb_sz_t lwrb_get_linear_block_write_length(const lwrb_t* buff);
|
||||||
|
lwrb_sz_t lwrb_advance(lwrb_t* buff, lwrb_sz_t len);
|
||||||
|
|
||||||
|
/* Search in buffer */
|
||||||
|
uint8_t lwrb_find(const lwrb_t* buff, const void* bts, lwrb_sz_t len, lwrb_sz_t start_offset, lwrb_sz_t* found_idx);
|
||||||
|
lwrb_sz_t lwrb_overwrite(lwrb_t* buff, const void* data, lwrb_sz_t btw);
|
||||||
|
lwrb_sz_t lwrb_move(lwrb_t* dest, lwrb_t* src);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \}
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif /* __cplusplus */
|
||||||
|
|
||||||
|
#endif /* LWRB_HDR_H */
|
||||||
645
3rd-lib/lwrb/src/lwrb.c
Normal file
645
3rd-lib/lwrb/src/lwrb.c
Normal file
@@ -0,0 +1,645 @@
|
|||||||
|
/**
|
||||||
|
* \file lwrb.c
|
||||||
|
* \brief Lightweight ring buffer
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2023 Tilen MAJERLE
|
||||||
|
*
|
||||||
|
* Permission is hereby granted, free of charge, to any person
|
||||||
|
* obtaining a copy of this software and associated documentation
|
||||||
|
* files (the "Software"), to deal in the Software without restriction,
|
||||||
|
* including without limitation the rights to use, copy, modify, merge,
|
||||||
|
* publish, distribute, sublicense, and/or sell copies of the Software,
|
||||||
|
* and to permit persons to whom the Software is furnished to do so,
|
||||||
|
* subject to the following conditions:
|
||||||
|
*
|
||||||
|
* The above copyright notice and this permission notice shall be
|
||||||
|
* included in all copies or substantial portions of the Software.
|
||||||
|
*
|
||||||
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||||
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
|
||||||
|
* OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
|
||||||
|
* HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
|
||||||
|
* WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
||||||
|
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
|
||||||
|
* OTHER DEALINGS IN THE SOFTWARE.
|
||||||
|
*
|
||||||
|
* This file is part of LwRB - Lightweight ring buffer library.
|
||||||
|
*
|
||||||
|
* Author: Tilen MAJERLE <tilen@majerle.eu>
|
||||||
|
* Version: v3.0.0
|
||||||
|
*/
|
||||||
|
#include "lwrb.h"
|
||||||
|
|
||||||
|
/* Memory set and copy functions */
|
||||||
|
#define BUF_MEMSET memset
|
||||||
|
#define BUF_MEMCPY memcpy
|
||||||
|
|
||||||
|
#define BUF_IS_VALID(b) ((b) != NULL && (b)->buff != NULL && (b)->size > 0)
|
||||||
|
#define BUF_MIN(x, y) ((x) < (y) ? (x) : (y))
|
||||||
|
#define BUF_MAX(x, y) ((x) > (y) ? (x) : (y))
|
||||||
|
#define BUF_SEND_EVT(b, type, bp) \
|
||||||
|
do { \
|
||||||
|
if ((b)->evt_fn != NULL) { \
|
||||||
|
(b)->evt_fn((void*)(b), (type), (bp)); \
|
||||||
|
} \
|
||||||
|
} while (0)
|
||||||
|
|
||||||
|
/* Optional atomic opeartions */
|
||||||
|
#ifdef LWRB_DISABLE_ATOMIC
|
||||||
|
#define LWRB_INIT(var, val) (var) = (val)
|
||||||
|
#define LWRB_LOAD(var, type) (var)
|
||||||
|
#define LWRB_STORE(var, val, type) (var) = (val)
|
||||||
|
#else
|
||||||
|
#define LWRB_INIT(var, val) atomic_init(&(var), (val))
|
||||||
|
#define LWRB_LOAD(var, type) atomic_load_explicit(&(var), (type))
|
||||||
|
#define LWRB_STORE(var, val, type) atomic_store_explicit(&(var), (val), (type))
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Initialize buffer handle to default values with size and buffer data array
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \param[in] buffdata: Pointer to memory to use as buffer data
|
||||||
|
* \param[in] size: Size of `buffdata` in units of bytes
|
||||||
|
* Maximum number of bytes buffer can hold is `size - 1`
|
||||||
|
* \return `1` on success, `0` otherwise
|
||||||
|
*/
|
||||||
|
uint8_t
|
||||||
|
lwrb_init(lwrb_t* buff, void* buffdata, lwrb_sz_t size) {
|
||||||
|
if (buff == NULL || buffdata == NULL || size == 0) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
buff->evt_fn = NULL;
|
||||||
|
buff->size = size;
|
||||||
|
buff->buff = buffdata;
|
||||||
|
LWRB_INIT(buff->w, 0);
|
||||||
|
LWRB_INIT(buff->r, 0);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Check if buff is initialized and ready to use
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \return `1` if ready, `0` otherwise
|
||||||
|
*/
|
||||||
|
uint8_t
|
||||||
|
lwrb_is_ready(lwrb_t* buff) {
|
||||||
|
return BUF_IS_VALID(buff);
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Free buffer memory
|
||||||
|
* \note Since implementation does not use dynamic allocation,
|
||||||
|
* it just sets buffer handle to `NULL`
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
*/
|
||||||
|
void
|
||||||
|
lwrb_free(lwrb_t* buff) {
|
||||||
|
if (BUF_IS_VALID(buff)) {
|
||||||
|
buff->buff = NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Set event function callback for different buffer operations
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \param[in] evt_fn: Callback function
|
||||||
|
*/
|
||||||
|
void
|
||||||
|
lwrb_set_evt_fn(lwrb_t* buff, lwrb_evt_fn evt_fn) {
|
||||||
|
if (BUF_IS_VALID(buff)) {
|
||||||
|
buff->evt_fn = evt_fn;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Write data to buffer.
|
||||||
|
* Copies data from `data` array to buffer and marks buffer as full for maximum `btw` number of bytes
|
||||||
|
*
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \param[in] data: Pointer to data to write into buffer
|
||||||
|
* \param[in] btw: Number of bytes to write
|
||||||
|
* \return Number of bytes written to buffer.
|
||||||
|
* When returned value is less than `btw`, there was no enough memory available
|
||||||
|
* to copy full data array.
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_write(lwrb_t* buff, const void* data, lwrb_sz_t btw) {
|
||||||
|
lwrb_sz_t written = 0;
|
||||||
|
|
||||||
|
if (lwrb_write_ex(buff, data, btw, &written, 0)) {
|
||||||
|
return written;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Write extended functionality
|
||||||
|
*
|
||||||
|
* \param buff: Ring buffer instance
|
||||||
|
* \param data: Pointer to data to write into buffer
|
||||||
|
* \param btw: Number of bytes to write
|
||||||
|
* \param bw: Output pointer to write number of bytes written
|
||||||
|
* \param flags: Optional flags.
|
||||||
|
* \ref LWRB_FLAG_WRITE_ALL: Request to write all data (up to btw).
|
||||||
|
* Will early return if no memory available
|
||||||
|
* \return `1` if write operation OK, `0` otherwise
|
||||||
|
*/
|
||||||
|
uint8_t
|
||||||
|
lwrb_write_ex(lwrb_t* buff, const void* data, lwrb_sz_t btw, lwrb_sz_t* bw, uint16_t flags) {
|
||||||
|
lwrb_sz_t tocopy, free, buff_w_ptr;
|
||||||
|
const uint8_t* d = data;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff) || data == NULL || btw == 0) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Calculate maximum number of bytes available to write */
|
||||||
|
free = lwrb_get_free(buff);
|
||||||
|
/* If no memory, or if user wants to write ALL data but no enough space, exit early */
|
||||||
|
if (free == 0 || (free < btw && flags & LWRB_FLAG_WRITE_ALL)) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
btw = BUF_MIN(free, btw);
|
||||||
|
buff_w_ptr = LWRB_LOAD(buff->w, memory_order_acquire);
|
||||||
|
|
||||||
|
/* Step 1: Write data to linear part of buffer */
|
||||||
|
tocopy = BUF_MIN(buff->size - buff_w_ptr, btw);
|
||||||
|
BUF_MEMCPY(&buff->buff[buff_w_ptr], d, tocopy);
|
||||||
|
buff_w_ptr += tocopy;
|
||||||
|
btw -= tocopy;
|
||||||
|
|
||||||
|
/* Step 2: Write data to beginning of buffer (overflow part) */
|
||||||
|
if (btw > 0) {
|
||||||
|
BUF_MEMCPY(buff->buff, &d[tocopy], btw);
|
||||||
|
buff_w_ptr = btw;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Step 3: Check end of buffer */
|
||||||
|
if (buff_w_ptr >= buff->size) {
|
||||||
|
buff_w_ptr = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Write final value to the actual running variable.
|
||||||
|
* This is to ensure no read operation can access intermediate data
|
||||||
|
*/
|
||||||
|
LWRB_STORE(buff->w, buff_w_ptr, memory_order_release);
|
||||||
|
|
||||||
|
BUF_SEND_EVT(buff, LWRB_EVT_WRITE, tocopy + btw);
|
||||||
|
if (bw != NULL) {
|
||||||
|
*bw = tocopy + btw;
|
||||||
|
}
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Read data from buffer.
|
||||||
|
* Copies data from buffer to `data` array and marks buffer as free for maximum `btr` number of bytes
|
||||||
|
*
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \param[out] data: Pointer to output memory to copy buffer data to
|
||||||
|
* \param[in] btr: Number of bytes to read
|
||||||
|
* \return Number of bytes read and copied to data array
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_read(lwrb_t* buff, void* data, lwrb_sz_t btr) {
|
||||||
|
lwrb_sz_t read = 0;
|
||||||
|
|
||||||
|
if (lwrb_read_ex(buff, data, btr, &read, 0)) {
|
||||||
|
return read;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Write extended functionality
|
||||||
|
*
|
||||||
|
* \param buff: Ring buffer instance
|
||||||
|
* \param data: Pointer to memory to write read data from buffer
|
||||||
|
* \param btr: Number of bytes to read
|
||||||
|
* \param br: Output pointer to write number of bytes read
|
||||||
|
* \param flags: Optional flags
|
||||||
|
* \ref LWRB_FLAG_READ_ALL: Request to read all data (up to btr).
|
||||||
|
* Will early return if no enough bytes in the buffer
|
||||||
|
* \return `1` if read operation OK, `0` otherwise
|
||||||
|
*/
|
||||||
|
uint8_t
|
||||||
|
lwrb_read_ex(lwrb_t* buff, void* data, lwrb_sz_t btr, lwrb_sz_t* br, uint16_t flags) {
|
||||||
|
lwrb_sz_t tocopy, full, buff_r_ptr;
|
||||||
|
uint8_t* d = data;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff) || data == NULL || btr == 0) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Calculate maximum number of bytes available to read */
|
||||||
|
full = lwrb_get_full(buff);
|
||||||
|
if (full == 0 || (full < btr && (flags & LWRB_FLAG_READ_ALL))) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
btr = BUF_MIN(full, btr);
|
||||||
|
buff_r_ptr = LWRB_LOAD(buff->r, memory_order_acquire);
|
||||||
|
|
||||||
|
/* Step 1: Read data from linear part of buffer */
|
||||||
|
tocopy = BUF_MIN(buff->size - buff_r_ptr, btr);
|
||||||
|
BUF_MEMCPY(d, &buff->buff[buff_r_ptr], tocopy);
|
||||||
|
buff_r_ptr += tocopy;
|
||||||
|
btr -= tocopy;
|
||||||
|
|
||||||
|
/* Step 2: Read data from beginning of buffer (overflow part) */
|
||||||
|
if (btr > 0) {
|
||||||
|
BUF_MEMCPY(&d[tocopy], buff->buff, btr);
|
||||||
|
buff_r_ptr = btr;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Step 3: Check end of buffer */
|
||||||
|
if (buff_r_ptr >= buff->size) {
|
||||||
|
buff_r_ptr = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Write final value to the actual running variable.
|
||||||
|
* This is to ensure no write operation can access intermediate data
|
||||||
|
*/
|
||||||
|
LWRB_STORE(buff->r, buff_r_ptr, memory_order_release);
|
||||||
|
|
||||||
|
BUF_SEND_EVT(buff, LWRB_EVT_READ, tocopy + btr);
|
||||||
|
if (br != NULL) {
|
||||||
|
*br = tocopy + btr;
|
||||||
|
}
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Read from buffer without changing read pointer (peek only)
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \param[in] skip_count: Number of bytes to skip before reading data
|
||||||
|
* \param[out] data: Pointer to output memory to copy buffer data to
|
||||||
|
* \param[in] btp: Number of bytes to peek
|
||||||
|
* \return Number of bytes peeked and written to output array
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_peek(const lwrb_t* buff, lwrb_sz_t skip_count, void* data, lwrb_sz_t btp) {
|
||||||
|
lwrb_sz_t full, tocopy, r;
|
||||||
|
uint8_t* d = data;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff) || data == NULL || btp == 0) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Calculate maximum number of bytes available to read
|
||||||
|
* and check if we can even fit to it
|
||||||
|
*/
|
||||||
|
full = lwrb_get_full(buff);
|
||||||
|
if (skip_count >= full) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
r = LWRB_LOAD(buff->r, memory_order_relaxed);
|
||||||
|
r += skip_count;
|
||||||
|
full -= skip_count;
|
||||||
|
if (r >= buff->size) {
|
||||||
|
r -= buff->size;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Check maximum number of bytes available to read after skip */
|
||||||
|
btp = BUF_MIN(full, btp);
|
||||||
|
if (btp == 0) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Step 1: Read data from linear part of buffer */
|
||||||
|
tocopy = BUF_MIN(buff->size - r, btp);
|
||||||
|
BUF_MEMCPY(d, &buff->buff[r], tocopy);
|
||||||
|
btp -= tocopy;
|
||||||
|
|
||||||
|
/* Step 2: Read data from beginning of buffer (overflow part) */
|
||||||
|
if (btp > 0) {
|
||||||
|
BUF_MEMCPY(&d[tocopy], buff->buff, btp);
|
||||||
|
}
|
||||||
|
return tocopy + btp;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Get available size in buffer for write operation
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \return Number of free bytes in memory
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_get_free(const lwrb_t* buff) {
|
||||||
|
lwrb_sz_t size, w, r;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff)) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Copy buffer pointers to local variables with atomic access.
|
||||||
|
*
|
||||||
|
* To ensure thread safety (only when in single-entry, single-exit FIFO mode use case),
|
||||||
|
* it is important to write buffer r and w values to local w and r variables.
|
||||||
|
*
|
||||||
|
* Local variables will ensure below if statements will always use the same value,
|
||||||
|
* even if buff->w or buff->r get changed during interrupt processing.
|
||||||
|
*
|
||||||
|
* They may change during load operation, important is that
|
||||||
|
* they do not change during if-elseif-else operations following these assignments.
|
||||||
|
*
|
||||||
|
* lwrb_get_free is only called for write purpose, and when in FIFO mode, then:
|
||||||
|
* - buff->w pointer will not change by another process/interrupt because we are in write mode just now
|
||||||
|
* - buff->r pointer may change by another process. If it gets changed after buff->r has been loaded to local variable,
|
||||||
|
* buffer will see "free size" less than it actually is. This is not a problem, application can
|
||||||
|
* always try again to write more data to remaining free memory that was read just during copy operation
|
||||||
|
*/
|
||||||
|
w = LWRB_LOAD(buff->w, memory_order_relaxed);
|
||||||
|
r = LWRB_LOAD(buff->r, memory_order_relaxed);
|
||||||
|
|
||||||
|
if (w == r) {
|
||||||
|
size = buff->size;
|
||||||
|
} else if (r > w) {
|
||||||
|
size = r - w;
|
||||||
|
} else {
|
||||||
|
size = buff->size - (w - r);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Buffer free size is always 1 less than actual size */
|
||||||
|
return size - 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Get number of bytes currently available in buffer
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \return Number of bytes ready to be read
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_get_full(const lwrb_t* buff) {
|
||||||
|
lwrb_sz_t size, w, r;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff)) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Copy buffer pointers to local variables.
|
||||||
|
*
|
||||||
|
* To ensure thread safety (only when in single-entry, single-exit FIFO mode use case),
|
||||||
|
* it is important to write buffer r and w values to local w and r variables.
|
||||||
|
*
|
||||||
|
* Local variables will ensure below if statements will always use the same value,
|
||||||
|
* even if buff->w or buff->r get changed during interrupt processing.
|
||||||
|
*
|
||||||
|
* They may change during load operation, important is that
|
||||||
|
* they do not change during if-elseif-else operations following these assignments.
|
||||||
|
*
|
||||||
|
* lwrb_get_full is only called for read purpose, and when in FIFO mode, then:
|
||||||
|
* - buff->r pointer will not change by another process/interrupt because we are in read mode just now
|
||||||
|
* - buff->w pointer may change by another process. If it gets changed after buff->w has been loaded to local variable,
|
||||||
|
* buffer will see "full size" less than it really is. This is not a problem, application can
|
||||||
|
* always try again to read more data from remaining full memory that was written just during copy operation
|
||||||
|
*/
|
||||||
|
w = LWRB_LOAD(buff->w, memory_order_relaxed);
|
||||||
|
r = LWRB_LOAD(buff->r, memory_order_relaxed);
|
||||||
|
|
||||||
|
if (w == r) {
|
||||||
|
size = 0;
|
||||||
|
} else if (w > r) {
|
||||||
|
size = w - r;
|
||||||
|
} else {
|
||||||
|
size = buff->size - (r - w);
|
||||||
|
}
|
||||||
|
return size;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Resets buffer to default values. Buffer size is not modified
|
||||||
|
* \note This function is not thread safe.
|
||||||
|
* When used, application must ensure there is no active read/write operation
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
*/
|
||||||
|
void
|
||||||
|
lwrb_reset(lwrb_t* buff) {
|
||||||
|
if (BUF_IS_VALID(buff)) {
|
||||||
|
LWRB_STORE(buff->w, 0, memory_order_release);
|
||||||
|
LWRB_STORE(buff->r, 0, memory_order_release);
|
||||||
|
BUF_SEND_EVT(buff, LWRB_EVT_RESET, 0);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Get linear address for buffer for fast read
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \return Linear buffer start address
|
||||||
|
*/
|
||||||
|
void*
|
||||||
|
lwrb_get_linear_block_read_address(const lwrb_t* buff) {
|
||||||
|
if (!BUF_IS_VALID(buff)) {
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
return &buff->buff[buff->r];
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Get length of linear block address before it overflows for read operation
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \return Linear buffer size in units of bytes for read operation
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_get_linear_block_read_length(const lwrb_t* buff) {
|
||||||
|
lwrb_sz_t len, w, r;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff)) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Use temporary values in case they are changed during operations.
|
||||||
|
* See lwrb_buff_free or lwrb_buff_full functions for more information why this is OK.
|
||||||
|
*/
|
||||||
|
w = LWRB_LOAD(buff->w, memory_order_relaxed);
|
||||||
|
r = LWRB_LOAD(buff->r, memory_order_relaxed);
|
||||||
|
|
||||||
|
if (w > r) {
|
||||||
|
len = w - r;
|
||||||
|
} else if (r > w) {
|
||||||
|
len = buff->size - r;
|
||||||
|
} else {
|
||||||
|
len = 0;
|
||||||
|
}
|
||||||
|
return len;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Skip (ignore; advance read pointer) buffer data
|
||||||
|
* Marks data as read in the buffer and increases free memory for up to `len` bytes
|
||||||
|
*
|
||||||
|
* \note Useful at the end of streaming transfer such as DMA
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \param[in] len: Number of bytes to skip and mark as read
|
||||||
|
* \return Number of bytes skipped
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_skip(lwrb_t* buff, lwrb_sz_t len) {
|
||||||
|
lwrb_sz_t full, r;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff) || len == 0) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
full = lwrb_get_full(buff);
|
||||||
|
len = BUF_MIN(len, full);
|
||||||
|
r = LWRB_LOAD(buff->r, memory_order_acquire);
|
||||||
|
r += len;
|
||||||
|
if (r >= buff->size) {
|
||||||
|
r -= buff->size;
|
||||||
|
}
|
||||||
|
LWRB_STORE(buff->r, r, memory_order_release);
|
||||||
|
BUF_SEND_EVT(buff, LWRB_EVT_READ, len);
|
||||||
|
return len;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Get linear address for buffer for fast read
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \return Linear buffer start address
|
||||||
|
*/
|
||||||
|
void*
|
||||||
|
lwrb_get_linear_block_write_address(const lwrb_t* buff) {
|
||||||
|
if (!BUF_IS_VALID(buff)) {
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
return &buff->buff[buff->w];
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Get length of linear block address before it overflows for write operation
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \return Linear buffer size in units of bytes for write operation
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_get_linear_block_write_length(const lwrb_t* buff) {
|
||||||
|
lwrb_sz_t len, w, r;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff)) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Use temporary values in case they are changed during operations.
|
||||||
|
* See lwrb_buff_free or lwrb_buff_full functions for more information why this is OK.
|
||||||
|
*/
|
||||||
|
w = LWRB_LOAD(buff->w, memory_order_relaxed);
|
||||||
|
r = LWRB_LOAD(buff->r, memory_order_relaxed);
|
||||||
|
|
||||||
|
if (w >= r) {
|
||||||
|
len = buff->size - w;
|
||||||
|
/*
|
||||||
|
* When read pointer is 0,
|
||||||
|
* maximal length is one less as if too many bytes
|
||||||
|
* are written, buffer would be considered empty again (r == w)
|
||||||
|
*/
|
||||||
|
if (r == 0) {
|
||||||
|
/*
|
||||||
|
* Cannot overflow:
|
||||||
|
* - If r is not 0, statement does not get called
|
||||||
|
* - buff->size cannot be 0 and if r is 0, len is greater 0
|
||||||
|
*/
|
||||||
|
--len;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
len = r - w - 1;
|
||||||
|
}
|
||||||
|
return len;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Advance write pointer in the buffer.
|
||||||
|
* Similar to skip function but modifies write pointer instead of read
|
||||||
|
*
|
||||||
|
* \note Useful when hardware is writing to buffer and application needs to increase number
|
||||||
|
* of bytes written to buffer by hardware
|
||||||
|
* \param[in] buff: Ring buffer instance
|
||||||
|
* \param[in] len: Number of bytes to advance
|
||||||
|
* \return Number of bytes advanced for write operation
|
||||||
|
*/
|
||||||
|
lwrb_sz_t
|
||||||
|
lwrb_advance(lwrb_t* buff, lwrb_sz_t len) {
|
||||||
|
lwrb_sz_t free, w;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff) || len == 0) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Use local variables before writing back to main structure */
|
||||||
|
free = lwrb_get_free(buff);
|
||||||
|
len = BUF_MIN(len, free);
|
||||||
|
w = LWRB_LOAD(buff->w, memory_order_acquire);
|
||||||
|
w += len;
|
||||||
|
if (w >= buff->size) {
|
||||||
|
w -= buff->size;
|
||||||
|
}
|
||||||
|
LWRB_STORE(buff->w, w, memory_order_release);
|
||||||
|
BUF_SEND_EVT(buff, LWRB_EVT_WRITE, len);
|
||||||
|
return len;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Searches for a *needle* in an array, starting from given offset.
|
||||||
|
*
|
||||||
|
* \note This function is not thread-safe.
|
||||||
|
*
|
||||||
|
* \param buff: Ring buffer to search for needle in
|
||||||
|
* \param bts: Constant byte array sequence to search for in a buffer
|
||||||
|
* \param len: Length of the \arg bts array
|
||||||
|
* \param start_offset: Start offset in the buffer
|
||||||
|
* \param found_idx: Pointer to variable to write index in array where bts has been found
|
||||||
|
* Must not be set to `NULL`
|
||||||
|
* \return `1` if \arg bts found, `0` otherwise
|
||||||
|
*/
|
||||||
|
uint8_t
|
||||||
|
lwrb_find(const lwrb_t* buff, const void* bts, lwrb_sz_t len, lwrb_sz_t start_offset, lwrb_sz_t* found_idx) {
|
||||||
|
lwrb_sz_t full, r, max_x;
|
||||||
|
uint8_t found = 0;
|
||||||
|
const uint8_t* needle = bts;
|
||||||
|
|
||||||
|
if (!BUF_IS_VALID(buff) || needle == NULL || len == 0 || found_idx == NULL) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
*found_idx = 0;
|
||||||
|
|
||||||
|
full = lwrb_get_full(buff);
|
||||||
|
/* Verify initial conditions */
|
||||||
|
if (full < (len + start_offset)) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Max number of for loops is buff_full - input_len - start_offset of buffer length */
|
||||||
|
max_x = full - len;
|
||||||
|
for (lwrb_sz_t skip_x = start_offset; !found && skip_x <= max_x; ++skip_x) {
|
||||||
|
found = 1; /* Found by default */
|
||||||
|
|
||||||
|
/* Prepare the starting point for reading */
|
||||||
|
r = buff->r + skip_x;
|
||||||
|
if (r >= buff->size) {
|
||||||
|
r -= buff->size;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Search in the buffer */
|
||||||
|
for (lwrb_sz_t i = 0; i < len; ++i) {
|
||||||
|
if (buff->buff[r] != needle[i]) {
|
||||||
|
found = 0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (++r >= buff->size) {
|
||||||
|
r = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (found) {
|
||||||
|
*found_idx = skip_x;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return found;
|
||||||
|
}
|
||||||
@@ -1,4 +1,6 @@
|
|||||||
# fireware_violet
|
# fireware_clover
|
||||||
|
|
||||||
|
> 白塔岭143-气垫船组-图像处理板固件仓库
|
||||||
|
|
||||||
## 1 使用 VSCode + EIDE + GCC + OpenOCD 开发
|
## 1 使用 VSCode + EIDE + GCC + OpenOCD 开发
|
||||||
|
|
||||||
@@ -21,9 +23,6 @@ pyhton ./set_eide_env.py
|
|||||||
## 2 常用快捷键
|
## 2 常用快捷键
|
||||||
|
|
||||||
* 编译：`F7`
|
* 编译：`F7`
|
||||||
|
|
||||||
* 下载：`Ctrl + Alt + D`
|
* 下载：`Ctrl + Alt + D`
|
||||||
|
|
||||||
* 擦除：`Ctrl + Alt + E`（虽然没什么用）
|
* 擦除：`Ctrl + Alt + E`（虽然没什么用）
|
||||||
|
|
||||||
* 调试：`F5` （需配合 Cortex-Debug 插件，由于不支持 `gdb version < 9` 设置起来稍微复杂，后面再补说明）
|
* 调试：`F5` （需配合 Cortex-Debug 插件，由于不支持 `gdb version < 9` 设置起来稍微复杂，后面再补说明）
|
||||||
|
|||||||
29
app/by_button.c
Normal file
29
app/by_button.c
Normal file
@@ -0,0 +1,29 @@
|
|||||||
|
#include "by_button.h"
|
||||||
|
|
||||||
|
#include "zf_common_headfile.h"
|
||||||
|
|
||||||
|
button_event_t button_event;
|
||||||
|
|
||||||
|
void by_button_init(void)
|
||||||
|
{
|
||||||
|
gpio_init(BUTTON_LEFT_PIN, GPI, 1, GPI_PULL_UP);
|
||||||
|
gpio_init(BUTTON_DOWN_PIN, GPI, 1, GPI_PULL_UP);
|
||||||
|
gpio_init(BUTTON_UP_PIN, GPI, 1, GPI_PULL_UP);
|
||||||
|
gpio_init(BUTTON_CENTER_PIN, GPI, 1, GPI_PULL_UP);
|
||||||
|
gpio_init(BUTTON_RIGHT_PIN, GPI, 1, GPI_PULL_UP);
|
||||||
|
gpio_init(BUTTON_SIDE_PIN, GPI, 1, GPI_PULL_UP);
|
||||||
|
|
||||||
|
exti_init(BUTTON_LEFT_PIN, EXTI_TRIGGER_FALLING);
|
||||||
|
exti_init(BUTTON_DOWN_PIN, EXTI_TRIGGER_FALLING);
|
||||||
|
exti_init(BUTTON_UP_PIN, EXTI_TRIGGER_FALLING);
|
||||||
|
exti_init(BUTTON_CENTER_PIN, EXTI_TRIGGER_BOTH);
|
||||||
|
exti_init(BUTTON_RIGHT_PIN, EXTI_TRIGGER_FALLING);
|
||||||
|
exti_init(BUTTON_SIDE_PIN, EXTI_TRIGGER_FALLING);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t by_button_get_status(void)
|
||||||
|
{
|
||||||
|
uint8_t temp_s = (uint8_t)button_event;
|
||||||
|
button_event = button_event_none;
|
||||||
|
return temp_s;
|
||||||
|
}
|
||||||
33
app/by_button.h
Normal file
33
app/by_button.h
Normal file
@@ -0,0 +1,33 @@
|
|||||||
|
#ifndef _BY_BUTTON_H__
|
||||||
|
#define _BY_BUTTON_H__
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#define LONG_PRESS_THRESHOLD_MS (300ULL)
|
||||||
|
#define LONG_PRESS_THRESHOLD_TICK (LONG_PRESS_THRESHOLD_MS * 18000ULL)
|
||||||
|
|
||||||
|
#define BUTTON_UP_PIN E12
|
||||||
|
#define BUTTON_DOWN_PIN E11
|
||||||
|
#define BUTTON_LEFT_PIN E10
|
||||||
|
#define BUTTON_RIGHT_PIN E14
|
||||||
|
#define BUTTON_CENTER_PIN E13
|
||||||
|
#define BUTTON_SIDE_PIN E15
|
||||||
|
|
||||||
|
typedef enum button_event_t{
|
||||||
|
button_event_none = 0,
|
||||||
|
button_event_up,
|
||||||
|
button_event_down,
|
||||||
|
button_event_left,
|
||||||
|
button_event_right,
|
||||||
|
button_event_center_sp,
|
||||||
|
button_event_center_lp,
|
||||||
|
button_event_side,
|
||||||
|
}button_event_t;
|
||||||
|
|
||||||
|
extern button_event_t button_event;
|
||||||
|
|
||||||
|
void by_button_init(void);
|
||||||
|
uint8_t by_button_get_status(void);
|
||||||
|
|
||||||
|
#endif
|
||||||
@@ -1,12 +1,13 @@
|
|||||||
#include "by_buzzer.h"
|
#include "by_buzzer.h"
|
||||||
#include "by_rt_button.h"
|
|
||||||
|
|
||||||
#include "zf_common_headfile.h"
|
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
|
#include "zf_common_headfile.h"
|
||||||
|
|
||||||
|
#define BUZZER_QUEUE_LENGTH 40
|
||||||
|
|
||||||
uint16_t queue_long = 0;
|
uint16_t queue_long = 0;
|
||||||
const uint32_t max_long = 40;
|
uint32_t a[40] = {0};
|
||||||
uint32_t a[40];
|
|
||||||
void queue_init(void)
|
void queue_init(void)
|
||||||
{
|
{
|
||||||
memset(a, 0, sizeof(a));
|
memset(a, 0, sizeof(a));
|
||||||
@@ -14,7 +15,7 @@ void queue_init(void)
|
|||||||
|
|
||||||
void queue_add_element(int element)
|
void queue_add_element(int element)
|
||||||
{
|
{
|
||||||
if (queue_long < max_long) {
|
if (queue_long < BUZZER_QUEUE_LENGTH) {
|
||||||
a[queue_long] = element;
|
a[queue_long] = element;
|
||||||
queue_long += 1;
|
queue_long += 1;
|
||||||
}
|
}
|
||||||
@@ -38,5 +39,25 @@ void queue_pop_read(void)
|
|||||||
|
|
||||||
void by_buzzer_init(void)
|
void by_buzzer_init(void)
|
||||||
{
|
{
|
||||||
|
queue_init();
|
||||||
pwm_init(BUZZER_PIN, 2000, 0);
|
pwm_init(BUZZER_PIN, 2000, 0);
|
||||||
|
|
||||||
|
by_buzzer_add(1250);
|
||||||
|
by_buzzer_add(1500);
|
||||||
|
by_buzzer_add(1750);
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_buzzer_add(uint16_t tone)
|
||||||
|
{
|
||||||
|
queue_add_element(tone);
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_buzzer_run(void)
|
||||||
|
{
|
||||||
|
if (queue_long != 0) {
|
||||||
|
pwm_init(BUZZER_PIN, a[0], 5000);
|
||||||
|
queue_pop_element();
|
||||||
|
system_delay_ms(100);
|
||||||
|
pwm_set_duty(BUZZER_PIN, 0);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
@@ -1,24 +1,24 @@
|
|||||||
#ifndef _BY_BUZZER_H__
|
#ifndef _BY_BUZZER_H__
|
||||||
#define _BY_BUZZER_H__
|
#define _BY_BUZZER_H__
|
||||||
|
|
||||||
#include "by_rt_button.h"
|
#include "zf_common_headfile.h"
|
||||||
|
|
||||||
#include "stdio.h"
|
|
||||||
#include "ch32v30x.h"
|
|
||||||
|
|
||||||
#define BY_PRESS_SHORT 2000
|
#define BY_PRESS_SHORT 2000
|
||||||
#define BY_PRESS_LONG 2500
|
#define BY_PRESS_LONG 2500
|
||||||
#define BY_FORWARD 1500
|
#define BY_FORWARD 1500
|
||||||
#define BY_BACKWARD 1800
|
#define BY_BACKWARD 1800
|
||||||
#define BUZZER_PIN TIM3_PWM_MAP0_CH2_A7
|
#define BUZZER_PIN TIM4_PWM_MAP1_CH3_D14
|
||||||
extern void by_buzzer_init(void);
|
|
||||||
extern void queue_init(void);
|
|
||||||
extern void queue_add_element(int element);
|
|
||||||
extern void queue_pop_element(void);
|
|
||||||
extern void queue_pop_read(void);
|
|
||||||
|
|
||||||
extern uint32_t a[40];
|
extern uint32_t a[40];
|
||||||
extern uint16_t queue_long;
|
extern uint16_t queue_long;
|
||||||
extern const uint32_t max_long;
|
extern const uint32_t max_long;
|
||||||
extern uint8_t queue_flag;
|
extern uint8_t queue_flag;
|
||||||
|
|
||||||
|
extern void queue_init(void);
|
||||||
|
extern void queue_add_element(int element);
|
||||||
|
extern void queue_pop_element(void);
|
||||||
|
extern void queue_pop_read(void);
|
||||||
|
extern void by_buzzer_init(void);
|
||||||
|
extern void by_buzzer_add(uint16_t tone);
|
||||||
|
extern void by_buzzer_run(void);
|
||||||
#endif
|
#endif
|
||||||
29
app/by_led.c
Normal file
29
app/by_led.c
Normal file
@@ -0,0 +1,29 @@
|
|||||||
|
#include "by_led.h"
|
||||||
|
|
||||||
|
#include "zf_common_headfile.h"
|
||||||
|
|
||||||
|
#define LED_WARN_PIN E9
|
||||||
|
#define LED_INFO_PIN E8
|
||||||
|
|
||||||
|
uint8_t led_warn_status = 1;
|
||||||
|
uint8_t led_info_status = 1;
|
||||||
|
|
||||||
|
// TODO 将队列抽象出去，具有 blink 属性的设备均可使用
|
||||||
|
|
||||||
|
void by_led_init(void)
|
||||||
|
{
|
||||||
|
gpio_init(LED_WARN_PIN, GPO, 0, GPO_PUSH_PULL);
|
||||||
|
gpio_init(LED_INFO_PIN, GPO, 0, GPO_PUSH_PULL);
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_led_warn_blink(void)
|
||||||
|
{
|
||||||
|
led_warn_status = !led_warn_status;
|
||||||
|
gpio_set_level(LED_WARN_PIN, led_warn_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_led_info_blink(void)
|
||||||
|
{
|
||||||
|
led_info_status = !led_info_status;
|
||||||
|
gpio_set_level(LED_INFO_PIN, led_info_status);
|
||||||
|
}
|
||||||
8
app/by_led.h
Normal file
8
app/by_led.h
Normal file
@@ -0,0 +1,8 @@
|
|||||||
|
#ifndef _BY_LED_H__
|
||||||
|
#define _BY_LED_H__
|
||||||
|
|
||||||
|
extern void by_led_init(void);
|
||||||
|
extern void by_led_warn_blink(void);
|
||||||
|
extern void by_led_info_blink(void);
|
||||||
|
|
||||||
|
#endif
|
||||||
@@ -1,26 +0,0 @@
|
|||||||
#include "by_rt_button.h"
|
|
||||||
#include "zf_common_headfile.h"
|
|
||||||
uint8_t rotate_button;
|
|
||||||
|
|
||||||
void by_gpio_init(void)
|
|
||||||
{
|
|
||||||
gpio_init(E10, GPI, GPIO_HIGH, GPI_PULL_UP);
|
|
||||||
}
|
|
||||||
|
|
||||||
void by_exit_init(void)
|
|
||||||
{
|
|
||||||
exti_init(E9, EXTI_TRIGGER_FALLING);
|
|
||||||
exti_init(E11, EXTI_TRIGGER_BOTH);
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief 查询旋钮状态 - 查询后状态归零
|
|
||||||
*
|
|
||||||
* @return uint8_t 当前旋钮状态
|
|
||||||
*/
|
|
||||||
uint8_t by_get_rb_status(void)
|
|
||||||
{
|
|
||||||
uint8_t temp_s = rotate_button;
|
|
||||||
rotate_button = 0;
|
|
||||||
return temp_s;
|
|
||||||
}
|
|
||||||
@@ -1,24 +0,0 @@
|
|||||||
#ifndef _BY_RT_BUTTON_H__
|
|
||||||
#define _BY_RT_BUTTON_H__
|
|
||||||
|
|
||||||
#include "stdio.h"
|
|
||||||
#include "ch32v30x.h"
|
|
||||||
|
|
||||||
#define LONG_PRESS_THRESHOLD_MS (300ULL)
|
|
||||||
#define LONG_PRESS_THRESHOLD_TICK (LONG_PRESS_THRESHOLD_MS * 18000ULL)
|
|
||||||
|
|
||||||
typedef enum rotate_button_event {
|
|
||||||
rotate_button_press_short = 1,
|
|
||||||
rotate_button_press_long = 2,
|
|
||||||
rotate_button_forward = 3,
|
|
||||||
rotate_button_backward = 4,
|
|
||||||
} rotate_button_event;
|
|
||||||
|
|
||||||
extern uint8_t rotate_button;
|
|
||||||
|
|
||||||
extern void by_exit_init(void);
|
|
||||||
extern void by_gpio_init(void);
|
|
||||||
extern uint8_t by_get_rb_status(void);
|
|
||||||
extern void by_ips_show(void);
|
|
||||||
|
|
||||||
#endif
|
|
||||||
@@ -4,7 +4,6 @@
|
|||||||
#include "gl_state.h"
|
#include "gl_state.h"
|
||||||
#include "gl_img_process.h"
|
#include "gl_img_process.h"
|
||||||
#include "gl_common.h"
|
#include "gl_common.h"
|
||||||
#include "main.h"
|
|
||||||
#include "gl_handle_img.h"
|
#include "gl_handle_img.h"
|
||||||
#include "gl_transform_table.h"
|
#include "gl_transform_table.h"
|
||||||
#include "gl_get_corners.h"
|
#include "gl_get_corners.h"
|
||||||
|
|||||||
107
app/isr.c
107
app/isr.c
@@ -34,10 +34,11 @@
|
|||||||
********************************************************************************************************************/
|
********************************************************************************************************************/
|
||||||
|
|
||||||
#include "zf_common_headfile.h"
|
#include "zf_common_headfile.h"
|
||||||
#include "by_rt_button.h"
|
#include "by_tiny_frame.h"
|
||||||
#include "jj_blueteeth.h"
|
#include "by_button.h"
|
||||||
#include "by_buzzer.h"
|
#include "by_buzzer.h"
|
||||||
#include "jj_blueteeth.h"
|
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
|
||||||
void NMI_Handler(void) __attribute__((interrupt()));
|
void NMI_Handler(void) __attribute__((interrupt()));
|
||||||
void HardFault_Handler(void) __attribute__((interrupt()));
|
void HardFault_Handler(void) __attribute__((interrupt()));
|
||||||
@@ -92,8 +93,9 @@ void USART1_IRQHandler(void)
|
|||||||
void USART2_IRQHandler(void)
|
void USART2_IRQHandler(void)
|
||||||
{
|
{
|
||||||
if (USART_GetITStatus(USART2, USART_IT_RXNE) != RESET) {
|
if (USART_GetITStatus(USART2, USART_IT_RXNE) != RESET) {
|
||||||
uart_query_byte(UART_2, &bt_buffer);
|
uint8_t data_s = 0;
|
||||||
bt_rx_flag = true;
|
uart_query_byte(UART_2, &data_s);
|
||||||
|
by_tiny_frame_parse_uart_handle(data_s);
|
||||||
USART_ClearITPendingBit(USART2, USART_IT_RXNE);
|
USART_ClearITPendingBit(USART2, USART_IT_RXNE);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -101,7 +103,7 @@ void USART3_IRQHandler(void)
|
|||||||
{
|
{
|
||||||
if (USART_GetITStatus(USART3, USART_IT_RXNE) != RESET) {
|
if (USART_GetITStatus(USART3, USART_IT_RXNE) != RESET) {
|
||||||
#if DEBUG_UART_USE_INTERRUPT // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> debug <20><><EFBFBD><EFBFBD><EFBFBD>ж<EFBFBD>
|
#if DEBUG_UART_USE_INTERRUPT // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> debug <20><><EFBFBD><EFBFBD><EFBFBD>ж<EFBFBD>
|
||||||
debug_interrupr_handler(); // <20><><EFBFBD><EFBFBD> debug <20><><EFBFBD>ڽ<EFBFBD><DABD>մ<EFBFBD><D5B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD>ݻᱻ debug <20><><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȡ
|
// debug_interrupr_handler(); // <20><><EFBFBD><EFBFBD> debug <20><><EFBFBD>ڽ<EFBFBD><DABD>մ<EFBFBD><D5B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD>ݻᱻ debug <20><><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȡ
|
||||||
#endif // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><DEB8><EFBFBD> DEBUG_UART_INDEX <20><><EFBFBD><EFBFBD><EFBFBD>δ<EFBFBD><CEB4><EFBFBD><EFBFBD><EFBFBD>Ҫ<EFBFBD>ŵ<EFBFBD><C5B5><EFBFBD>Ӧ<EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD>ж<EFBFBD>ȥ
|
#endif // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><DEB8><EFBFBD> DEBUG_UART_INDEX <20><><EFBFBD><EFBFBD><EFBFBD>δ<EFBFBD><CEB4><EFBFBD><EFBFBD><EFBFBD>Ҫ<EFBFBD>ŵ<EFBFBD><C5B5><EFBFBD>Ӧ<EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD>ж<EFBFBD>ȥ
|
||||||
USART_ClearITPendingBit(USART3, USART_IT_RXNE);
|
USART_ClearITPendingBit(USART3, USART_IT_RXNE);
|
||||||
}
|
}
|
||||||
@@ -199,14 +201,6 @@ void EXTI9_5_IRQHandler(void)
|
|||||||
EXTI_ClearITPendingBit(EXTI_Line8);
|
EXTI_ClearITPendingBit(EXTI_Line8);
|
||||||
}
|
}
|
||||||
if (SET == EXTI_GetITStatus(EXTI_Line9)) {
|
if (SET == EXTI_GetITStatus(EXTI_Line9)) {
|
||||||
|
|
||||||
if (SET == gpio_get_level(E10)) {
|
|
||||||
rotate_button = rotate_button_backward;
|
|
||||||
queue_add_element(BY_BACKWARD);
|
|
||||||
} else {
|
|
||||||
rotate_button = rotate_button_forward;
|
|
||||||
queue_add_element(BY_FORWARD);
|
|
||||||
}
|
|
||||||
EXTI_ClearITPendingBit(EXTI_Line9);
|
EXTI_ClearITPendingBit(EXTI_Line9);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -214,64 +208,83 @@ void EXTI9_5_IRQHandler(void)
|
|||||||
void EXTI15_10_IRQHandler(void)
|
void EXTI15_10_IRQHandler(void)
|
||||||
{
|
{
|
||||||
if (SET == EXTI_GetITStatus(EXTI_Line10)) {
|
if (SET == EXTI_GetITStatus(EXTI_Line10)) {
|
||||||
|
if (button_event == button_event_none) {
|
||||||
// <20>˴<EFBFBD><CBB4><EFBFBD>д<EFBFBD>û<EFBFBD><C3BB><EFBFBD><EFBFBD><EFBFBD> (A10/B10..E10) <20><><EFBFBD>Ŵ<EFBFBD><C5B4><EFBFBD>
|
system_delay_ms(10);
|
||||||
|
if (RESET == gpio_get_level(BUTTON_LEFT_PIN)) {
|
||||||
// <20>˴<EFBFBD><CBB4><EFBFBD>д<EFBFBD>û<EFBFBD><C3BB><EFBFBD><EFBFBD><EFBFBD> (A10/B10..E10) <20><><EFBFBD>Ŵ<EFBFBD><C5B4><EFBFBD>
|
button_event = button_event_left;
|
||||||
|
}
|
||||||
|
by_buzzer_add(1250);
|
||||||
|
}
|
||||||
EXTI_ClearITPendingBit(EXTI_Line10);
|
EXTI_ClearITPendingBit(EXTI_Line10);
|
||||||
}
|
}
|
||||||
if (SET == EXTI_GetITStatus(EXTI_Line11)) {
|
if (SET == EXTI_GetITStatus(EXTI_Line11)) {
|
||||||
static uint64_t time_via = 0;
|
if (button_event == button_event_none) {
|
||||||
system_delay_ms(10);
|
system_delay_ms(10);
|
||||||
if (RESET == gpio_get_level(E11)) {
|
if (RESET == gpio_get_level(BUTTON_DOWN_PIN)) {
|
||||||
time_via = system_get_tick();
|
button_event = button_event_down;
|
||||||
EXTI_ClearITPendingBit(EXTI_Line11);
|
}
|
||||||
} else if (SET == gpio_get_level(E11)) {
|
by_buzzer_add(1250);
|
||||||
time_via = system_get_tick() - time_via;
|
|
||||||
if (time_via > LONG_PRESS_THRESHOLD_TICK) {
|
|
||||||
rotate_button = rotate_button_press_long;
|
|
||||||
queue_add_element(BY_PRESS_LONG);
|
|
||||||
|
|
||||||
} else {
|
|
||||||
rotate_button = rotate_button_press_short;
|
|
||||||
queue_add_element(BY_PRESS_SHORT);
|
|
||||||
}
|
}
|
||||||
time_via = 0;
|
|
||||||
EXTI_ClearITPendingBit(EXTI_Line11);
|
EXTI_ClearITPendingBit(EXTI_Line11);
|
||||||
}
|
}
|
||||||
if (SET == EXTI_GetITStatus(EXTI_Line12)) {
|
if (SET == EXTI_GetITStatus(EXTI_Line12)) {
|
||||||
|
if (button_event == button_event_none) {
|
||||||
|
system_delay_ms(10);
|
||||||
|
if (RESET == gpio_get_level(BUTTON_UP_PIN)) {
|
||||||
|
button_event = button_event_up;
|
||||||
|
}
|
||||||
|
by_buzzer_add(1250);
|
||||||
|
}
|
||||||
EXTI_ClearITPendingBit(EXTI_Line12);
|
EXTI_ClearITPendingBit(EXTI_Line12);
|
||||||
}
|
}
|
||||||
if (SET == EXTI_GetITStatus(EXTI_Line13)) {
|
if (SET == EXTI_GetITStatus(EXTI_Line13)) {
|
||||||
// -----------------* ToF INT <20><><EFBFBD><EFBFBD><EFBFBD>ж<EFBFBD> Ԥ<><D4A4><EFBFBD>жϴ<D0B6><CFB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> *-----------------
|
if (button_event == button_event_none) {
|
||||||
tof_module_exti_handler();
|
static uint64_t time_via = 0;
|
||||||
// -----------------* ToF INT <20><><EFBFBD><EFBFBD><EFBFBD>ж<EFBFBD> Ԥ<><D4A4><EFBFBD>жϴ<D0B6><CFB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> *-----------------
|
system_delay_ms(10);
|
||||||
// <20>˴<EFBFBD><CBB4><EFBFBD>д<EFBFBD>û<EFBFBD><C3BB><EFBFBD><EFBFBD><EFBFBD> (A13/B13..E13) <20><><EFBFBD>Ŵ<EFBFBD><C5B4><EFBFBD>
|
if (RESET == gpio_get_level(BUTTON_CENTER_PIN)) {
|
||||||
|
time_via = system_get_tick();
|
||||||
// <20>˴<EFBFBD><CBB4><EFBFBD>д<EFBFBD>û<EFBFBD><C3BB><EFBFBD><EFBFBD><EFBFBD> (A13/B13..E13) <20><><EFBFBD>Ŵ<EFBFBD><C5B4><EFBFBD>
|
} else if (SET == gpio_get_level(BUTTON_CENTER_PIN)) {
|
||||||
|
time_via = system_get_tick() - time_via;
|
||||||
|
if (time_via > LONG_PRESS_THRESHOLD_TICK) {
|
||||||
|
button_event = button_event_center_lp;
|
||||||
|
by_buzzer_add(2000);
|
||||||
|
} else {
|
||||||
|
button_event = button_event_center_sp;
|
||||||
|
by_buzzer_add(1800);
|
||||||
|
}
|
||||||
|
time_via = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
EXTI_ClearITPendingBit(EXTI_Line13);
|
EXTI_ClearITPendingBit(EXTI_Line13);
|
||||||
}
|
}
|
||||||
if (SET == EXTI_GetITStatus(EXTI_Line14)) {
|
if (SET == EXTI_GetITStatus(EXTI_Line14)) {
|
||||||
// -----------------* DM1XA <20><><EFBFBD>ź<EFBFBD> Ԥ<><D4A4><EFBFBD>жϴ<D0B6><CFB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> *-----------------
|
if (button_event == button_event_none) {
|
||||||
dm1xa_light_callback();
|
system_delay_ms(10);
|
||||||
// -----------------* DM1XA <20><><EFBFBD>ź<EFBFBD> Ԥ<><D4A4><EFBFBD>жϴ<D0B6><CFB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> *-----------------
|
if (RESET == gpio_get_level(BUTTON_RIGHT_PIN)) {
|
||||||
|
button_event = button_event_right;
|
||||||
|
by_buzzer_add(1250);
|
||||||
|
}
|
||||||
|
}
|
||||||
EXTI_ClearITPendingBit(EXTI_Line14);
|
EXTI_ClearITPendingBit(EXTI_Line14);
|
||||||
}
|
}
|
||||||
if (SET == EXTI_GetITStatus(EXTI_Line15)) {
|
if (SET == EXTI_GetITStatus(EXTI_Line15)) {
|
||||||
// -----------------* DM1XA <20><>/<2F><><EFBFBD><EFBFBD><EFBFBD>ź<EFBFBD> Ԥ<><D4A4><EFBFBD>жϴ<D0B6><CFB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> *-----------------
|
if (button_event == button_event_none) {
|
||||||
dm1xa_sound_callback();
|
system_delay_ms(10);
|
||||||
// -----------------* DM1XA <20><>/<2F><><EFBFBD><EFBFBD><EFBFBD>ź<EFBFBD> Ԥ<><D4A4><EFBFBD>жϴ<D0B6><CFB4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> *-----------------
|
if (RESET == gpio_get_level(BUTTON_SIDE_PIN)) {
|
||||||
EXTI_ClearITPendingBit(EXTI_Line15);
|
button_event = button_event_side;
|
||||||
|
by_buzzer_add(2000);
|
||||||
|
by_buzzer_add(1500);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
EXTI_ClearITPendingBit(EXTI_Line15);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void TIM1_UP_IRQHandler(void)
|
void TIM1_UP_IRQHandler(void)
|
||||||
{
|
{
|
||||||
if (TIM_GetITStatus(TIM1, TIM_IT_Update) != RESET) {
|
if (TIM_GetITStatus(TIM1, TIM_IT_Update) != RESET) {
|
||||||
TIM_ClearITPendingBit(TIM1, TIM_IT_Update);
|
TIM_ClearITPendingBit(TIM1, TIM_IT_Update);
|
||||||
|
by_tiny_frame_parse_timer_handle();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -1,74 +1,32 @@
|
|||||||
#include "jj_blueteeth.h"
|
#include "jj_blueteeth.h"
|
||||||
|
|
||||||
|
#include "zf_common_headfile.h"
|
||||||
|
|
||||||
|
#define BT_UART_BAUDRATE (115200)
|
||||||
|
#define BT_UART_INDEX UART_8
|
||||||
|
#define BT_UART_TX_PIN UART8_MAP0_TX_C4
|
||||||
|
#define BT_UART_RX_PIN UART8_MAP0_RX_C5
|
||||||
|
|
||||||
bool bt_rx_flag = false;
|
bool bt_rx_flag = false;
|
||||||
bool bt_run_flag = false;
|
|
||||||
bool bt_flow_flag = false;
|
|
||||||
uint8_t bt_buffer; // 接收字符存入
|
uint8_t bt_buffer; // 接收字符存入
|
||||||
uint32_t bt_run = 0;
|
|
||||||
uint32_t bt_flow = 0;
|
|
||||||
float bt_angle = 0.0f;
|
|
||||||
enum bt_order {
|
|
||||||
Start_work = 0x01,
|
|
||||||
Turn_Left = 0x02,
|
|
||||||
Turn_Right = 0x03,
|
|
||||||
Speed_up = 0x04,
|
|
||||||
Speed_down = 0x05,
|
|
||||||
Run_flag = 0x06,
|
|
||||||
Flow_flag = 0x08,
|
|
||||||
Flow_up = 0x09,
|
|
||||||
Flow_down = 0x10,
|
|
||||||
};
|
|
||||||
/**
|
/**
|
||||||
* @brief 蓝牙初始化
|
* @brief 蓝牙初始化
|
||||||
* @retval 无
|
* @retval 无
|
||||||
*/
|
*/
|
||||||
void jj_bt_init()
|
void jj_bt_init()
|
||||||
{
|
{
|
||||||
uart_init(UART_2, 115200, UART2_MAP1_TX_D5, UART2_MAP1_RX_D6);
|
uart_init(BT_UART_INDEX, BT_UART_BAUDRATE, BT_UART_TX_PIN, UART8_MAP0_RX_C5);
|
||||||
uart_rx_interrupt(UART_2, ENABLE);
|
uart_rx_interrupt(BT_UART_INDEX, ENABLE);
|
||||||
}
|
}
|
||||||
/**
|
/**
|
||||||
* @brief 蓝牙中断回调
|
*@brief 蓝牙中断回调函数
|
||||||
*
|
|
||||||
*/
|
*/
|
||||||
void jj_bt_run()
|
void jj_bt_run()
|
||||||
{
|
{
|
||||||
if (bt_rx_flag) {
|
|
||||||
switch (bt_buffer) {
|
|
||||||
case Start_work:
|
|
||||||
|
|
||||||
break;
|
|
||||||
case Turn_Left:
|
|
||||||
|
|
||||||
break;
|
|
||||||
case Turn_Right:
|
|
||||||
|
|
||||||
break;
|
|
||||||
case Speed_down:
|
|
||||||
bt_run -= 10;
|
|
||||||
break;
|
|
||||||
case Speed_up:
|
|
||||||
bt_run += 10;
|
|
||||||
break;
|
|
||||||
case Run_flag:
|
|
||||||
bt_run_flag = !bt_run_flag;
|
|
||||||
break;
|
|
||||||
case Flow_flag:
|
|
||||||
bt_flow_flag = !bt_flow_flag;
|
|
||||||
break;
|
|
||||||
case Flow_up:
|
|
||||||
bt_flow += 20;
|
|
||||||
break;
|
|
||||||
case Flow_down:
|
|
||||||
bt_flow -= 20;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
bt_rx_flag = false;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void bt_printf(const char *format, ...)
|
void jj_bt_printf(const char *format, ...)
|
||||||
{
|
{
|
||||||
char sbuf[40];
|
char sbuf[40];
|
||||||
va_list args;
|
va_list args;
|
||||||
@@ -77,8 +35,8 @@ void bt_printf(const char *format, ...)
|
|||||||
va_end(args);
|
va_end(args);
|
||||||
|
|
||||||
for (uint16_t i = 0; i < strlen(sbuf); i++) {
|
for (uint16_t i = 0; i < strlen(sbuf); i++) {
|
||||||
while (USART_GetFlagStatus((USART_TypeDef *)uart_index[UART_2], USART_FLAG_TC) == RESET)
|
while (USART_GetFlagStatus((USART_TypeDef *)uart_index[BT_UART_INDEX], USART_FLAG_TC) == RESET)
|
||||||
;
|
;
|
||||||
USART_SendData((USART_TypeDef *)uart_index[UART_2], sbuf[i]);
|
USART_SendData((USART_TypeDef *)uart_index[BT_UART_INDEX], sbuf[i]);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -1,18 +1,9 @@
|
|||||||
#ifndef _JJ_BLUETEETH_H_
|
#ifndef _JJ_BLUETEETH_H_
|
||||||
#define _JJ_BLUETEETH_H_
|
#define _JJ_BLUETEETH_H_
|
||||||
#include "stdio.h"
|
|
||||||
#include "zf_driver_uart.h"
|
|
||||||
|
|
||||||
extern bool bt_rx_flag;
|
#include "stdio.h"
|
||||||
extern bool bt_run_flag;
|
|
||||||
extern bool bt_flow_flag;
|
|
||||||
extern uint8_t bt_buffer;
|
|
||||||
extern uint32_t bt_run;
|
|
||||||
extern uint32_t bt_flow;
|
|
||||||
extern float bt_angle;
|
|
||||||
|
|
||||||
void jj_bt_init();
|
void jj_bt_init();
|
||||||
void jj_bt_run();
|
void jj_bt_run();
|
||||||
void bt_printf(const char *format, ...);
|
void jj_bt_printf(const char *format, ...);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
@@ -5,28 +5,40 @@
|
|||||||
PARAM_INFO Param_Data[DATA_NUM];
|
PARAM_INFO Param_Data[DATA_NUM];
|
||||||
soft_iic_info_struct eeprom_param;
|
soft_iic_info_struct eeprom_param;
|
||||||
TYPE_UNION iic_buffer[DATA_IN_FLASH_NUM];
|
TYPE_UNION iic_buffer[DATA_IN_FLASH_NUM];
|
||||||
|
TYPE_UNION tiny_frame_param[20];
|
||||||
|
uint32_t *addre[2];
|
||||||
|
float data0 = 1.0f;
|
||||||
|
float data1 = 1.05f;
|
||||||
|
float data2 = 10.0f;
|
||||||
|
float data3 = 100.0f;
|
||||||
|
float data4 = 4.0f;
|
||||||
|
float data5 = 66.0f;
|
||||||
|
float data6 = 13.130f;
|
||||||
|
float data7 = 10.0f;
|
||||||
|
float data8 = 0.0f;
|
||||||
/**
|
/**
|
||||||
* @brief 参数初始化注册
|
* @brief 参数初始化注册
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
void jj_param_eeprom_init()
|
void jj_param_eeprom_init(void)
|
||||||
{
|
{
|
||||||
soft_iic_init(&eeprom_param, K24C02_DEV_ADDR, K24C02_SOFT_IIC_DELAY, K24C02_SCL_PIN, K24C02_SDA_PIN); // eeprom初始化
|
soft_iic_init(&eeprom_param, K24C02_DEV_ADDR, K24C02_SOFT_IIC_DELAY, K24C02_SCL_PIN, K24C02_SDA_PIN); // eeprom初始化
|
||||||
//PARAM_REG(CA_PT_MAXLEN, &PT_MAXLEN, EFLOAT, 1, "PT_MAXLEN:"); // 注冊
|
PARAM_REG(angle_Kp, &data0, EFLOAT, 1, "an_P:"); // 注冊
|
||||||
// PARAM_REG(CA_FIX_BINTHRESHOLD, &FIX_BINTHRESHOLD, EFLOAT, 1, "FIX_BINTHRESHOLD:"); // 注冊
|
PARAM_REG(angle_Ki, &data1, EFLOAT, 1, "an_I:"); // 注冊
|
||||||
// PARAM_REG(CA_PIXPERMETER, &PIXPERMETER, EFLOAT, 1, "PIXPERMETER:"); // 注冊
|
PARAM_REG(angle_Kd, &data2, EFLOAT, 1, "an_D:"); // 注冊
|
||||||
// PARAM_REG(CA_RESAMPLEDIST, &RESAMPLEDIST, EFLOAT, 1, "RESAMPLEDIST:"); // 注冊
|
PARAM_REG(imgax_Kp, &data3, EFLOAT, 1, "im_P:"); // 注冊
|
||||||
// PARAM_REG(CA_COMMON_AIM, &COMMON_AIM, EFLOAT, 1, "COMMON_AIM:"); // 注冊
|
PARAM_REG(imgax_Ki, &data4, EFLOAT, 1, "im_I:"); // 注冊
|
||||||
// PARAM_REG(CA_CROSS_AIM, &CROSS_AIM, EFLOAT, 1, "CROSS_AIM:");
|
PARAM_REG(imgax_Kd, &data5, EFLOAT, 1, "im_D:");
|
||||||
|
PARAM_REG(other , &data6, EFLOAT, 1, "add:");
|
||||||
|
PARAM_REG(delta_x , &data7, EFLOAT, 2, "delta_x:");
|
||||||
|
PARAM_REG(delta_y , &data8, EFLOAT, 0, "delta_y:");
|
||||||
|
jj_param_read(); // 注冊
|
||||||
}
|
}
|
||||||
/**
|
/**
|
||||||
* @brief 参数写入
|
* @brief 参数写入
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
void jj_param_write()
|
void jj_param_write(void)
|
||||||
{
|
{
|
||||||
for (uint8 i = 0; i < DATA_IN_FLASH_NUM; i++) {
|
for (uint8 i = 0; i < DATA_IN_FLASH_NUM; i++) {
|
||||||
switch (Param_Data[i].type) {
|
switch (Param_Data[i].type) {
|
||||||
@@ -34,15 +46,15 @@ void jj_param_write()
|
|||||||
iic_buffer[i].f32 = *((float *)(Param_Data[i].p_data));
|
iic_buffer[i].f32 = *((float *)(Param_Data[i].p_data));
|
||||||
break;
|
break;
|
||||||
case EUINT32:
|
case EUINT32:
|
||||||
iic_buffer[i].u32 = *((uint32_t *)(Param_Data[i].p_data));
|
iic_buffer[i].u32 = *((uint32 *)(Param_Data[i].p_data));
|
||||||
break;
|
break;
|
||||||
case EINT32:
|
case EINT32:
|
||||||
iic_buffer[i].s32 = *((int32_t *)(Param_Data[i].p_data));
|
iic_buffer[i].s32 = *((int32 *)(Param_Data[i].p_data));
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
soft_iic_write_8bit_registers(&eeprom_param, 4 * i, (uint8_t *)&iic_buffer[i], 4);
|
eep_soft_iic_write_8bit_registers(&eeprom_param, (4 * i) >> 8, (4 * i), (uint8 *)&iic_buffer[i], 4);
|
||||||
system_delay_ms(10);
|
system_delay_ms(10);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -50,11 +62,11 @@ void jj_param_write()
|
|||||||
* @brief 参数读出
|
* @brief 参数读出
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
void jj_param_read()
|
void jj_param_read(void)
|
||||||
{
|
{
|
||||||
for (uint8 i = 0; i < DATA_IN_FLASH_NUM; i++) {
|
for (uint8 i = 0; i < DATA_IN_FLASH_NUM; i++) {
|
||||||
|
|
||||||
soft_iic_read_8bit_registers(&eeprom_param, 4 * i, (uint8 *)&iic_buffer[i], 4);
|
eep_soft_iic_read_8bit_registers(&eeprom_param, (4 * i) >> 8, (4 * i), (uint8 *)&iic_buffer[i], 4);
|
||||||
switch (Param_Data[i].type) {
|
switch (Param_Data[i].type) {
|
||||||
case EFLOAT:
|
case EFLOAT:
|
||||||
*((float *)(Param_Data[i].p_data)) =
|
*((float *)(Param_Data[i].p_data)) =
|
||||||
|
|||||||
@@ -12,19 +12,28 @@
|
|||||||
Param_Data[_data_tag_].p_data = (void *)_p_data_; \
|
Param_Data[_data_tag_].p_data = (void *)_p_data_; \
|
||||||
Param_Data[_data_tag_].type = _type_; \
|
Param_Data[_data_tag_].type = _type_; \
|
||||||
Param_Data[_data_tag_].cmd = _cmd_; \
|
Param_Data[_data_tag_].cmd = _cmd_; \
|
||||||
Param_Data[_data_tag_].text = _text_; \
|
Param_Data[_data_tag_].text = _text_;
|
||||||
//zf_assert(sizeof(_p_data_)<4);
|
|
||||||
|
|
||||||
typedef enum {
|
typedef enum {
|
||||||
DATA_HEAD = -1,
|
|
||||||
CA_PT_MAXLEN,
|
|
||||||
CA_FIX_BINTHRESHOLD,
|
|
||||||
CA_PIXPERMETER,
|
|
||||||
CA_RESAMPLEDIST,
|
|
||||||
CA_COMMON_AIM,
|
|
||||||
CA_CROSS_AIM,
|
|
||||||
|
|
||||||
|
Page1_head=0,
|
||||||
|
|
||||||
|
angle_Kp=Page1_head,
|
||||||
|
angle_Ki,
|
||||||
|
angle_Kd,
|
||||||
|
other,
|
||||||
|
|
||||||
|
Page2_head,
|
||||||
|
// 第二页参数
|
||||||
|
imgax_Kp=Page2_head,
|
||||||
|
imgax_Ki,
|
||||||
|
imgax_Kd,
|
||||||
|
|
||||||
|
Page3_head,
|
||||||
DATA_IN_FLASH_NUM,
|
DATA_IN_FLASH_NUM,
|
||||||
|
|
||||||
|
delta_x,
|
||||||
|
delta_y,
|
||||||
DATA_NUM,
|
DATA_NUM,
|
||||||
} data_tag_t;
|
} data_tag_t;
|
||||||
|
|
||||||
@@ -38,22 +47,21 @@ typedef union {
|
|||||||
uint32_t u32;
|
uint32_t u32;
|
||||||
int32_t s32;
|
int32_t s32;
|
||||||
float f32;
|
float f32;
|
||||||
uint8_t u8[4];
|
uint8_t u8;
|
||||||
} TYPE_UNION;
|
} TYPE_UNION;
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
void *p_data;
|
void *p_data;
|
||||||
ENUM_TYPE type;
|
ENUM_TYPE type;
|
||||||
uint8_t cmd;
|
uint8_t cmd;//01:仅存储 00：仅显示 02：传输并显示
|
||||||
char *text;
|
char *text;
|
||||||
} PARAM_INFO;
|
} PARAM_INFO;
|
||||||
|
|
||||||
extern soft_iic_info_struct eeprom_param;
|
extern soft_iic_info_struct eeprom_param;
|
||||||
extern PARAM_INFO Param_Data[DATA_NUM];
|
extern PARAM_INFO Param_Data[DATA_NUM];
|
||||||
extern TYPE_UNION iic_buffer[DATA_IN_FLASH_NUM];
|
extern TYPE_UNION iic_buffer[DATA_IN_FLASH_NUM];
|
||||||
|
extern TYPE_UNION tiny_frame_param[20];
|
||||||
void jj_param_eeprom_init();
|
void jj_param_eeprom_init(void);
|
||||||
void jj_param_read();
|
void jj_param_write(void);
|
||||||
void jj_param_write();
|
void jj_param_read(void);
|
||||||
|
extern float data7;
|
||||||
#endif
|
#endif
|
||||||
76
app/main.c
76
app/main.c
@@ -21,51 +21,77 @@
|
|||||||
* 许可证副本在 libraries 文件夹下 即该文件夹下的 LICENSE 文件
|
* 许可证副本在 libraries 文件夹下 即该文件夹下的 LICENSE 文件
|
||||||
* 欢迎各位使用并传播本程序 但修改内容时必须保留逐飞科技的版权声明（即本声明）
|
* 欢迎各位使用并传播本程序 但修改内容时必须保留逐飞科技的版权声明（即本声明）
|
||||||
********************************************************************************************************************/
|
********************************************************************************************************************/
|
||||||
|
#include "zf_common_headfile.h"
|
||||||
#include "gl_headfile.h"
|
#include "gl_headfile.h"
|
||||||
#include "by_rt_button.h"
|
#include "page.h"
|
||||||
#include "./page/page.h"
|
#include "by_tiny_frame.h"
|
||||||
#include "jj_blueteeth.h"
|
|
||||||
#include "jj_param.h"
|
|
||||||
#include "./page/page_ui_widget.h"
|
|
||||||
#include "by_buzzer.h"
|
#include "by_buzzer.h"
|
||||||
|
#include "by_led.h"
|
||||||
|
#include "jj_param.h"
|
||||||
|
#include "jj_blueteeth.h"
|
||||||
|
|
||||||
|
/** 测试完成后移除 **/
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
#include "by_tiny_frame_pack.h"
|
||||||
|
uint32_t data_test;
|
||||||
|
/** 测试完成后移除 **/
|
||||||
|
|
||||||
|
void test(by_tf_parse_frame_t frame_s, uint8_t status)
|
||||||
|
{
|
||||||
|
printf("parse done\r\n");
|
||||||
|
printf("--cmd: %0.2X\n--reg_addr: %0.4X\n--data: %0.8X\r\n", frame_s.cmd, frame_s.reg_addr, frame_s.data);
|
||||||
|
if (status) {
|
||||||
|
printf("noooooooo!\r\n");
|
||||||
|
} else {
|
||||||
|
printf("hhhhhhok\r\n");
|
||||||
|
}
|
||||||
|
}
|
||||||
int main(void)
|
int main(void)
|
||||||
{
|
{
|
||||||
|
|
||||||
clock_init(SYSTEM_CLOCK_120M);
|
clock_init(SYSTEM_CLOCK_144M);
|
||||||
system_delay_init();
|
system_delay_init();
|
||||||
debug_init();
|
debug_init();
|
||||||
mt9v03x_init();
|
mt9v03x_init();
|
||||||
ips200_init(IPS200_TYPE_SPI);
|
ips200_init(IPS200_TYPE_SPI);
|
||||||
by_gpio_init();
|
|
||||||
by_exit_init();
|
by_led_init();
|
||||||
|
// by_buzzer_init();
|
||||||
|
by_button_init();
|
||||||
|
|
||||||
jj_bt_init();
|
jj_bt_init();
|
||||||
by_buzzer_init();
|
|
||||||
jj_param_eeprom_init();
|
jj_param_eeprom_init();
|
||||||
|
|
||||||
Page_Init();
|
Page_Init();
|
||||||
|
|
||||||
|
pit_ms_init(TIM1_PIT, 1);
|
||||||
|
|
||||||
|
by_tiny_frame_init();
|
||||||
|
printf("start running\r\n");
|
||||||
|
tiny_frame_param[0].f32 = 100.5f;
|
||||||
|
// by_tiny_frame_read(0x0D, 0x4059, &data_test);
|
||||||
while (1) {
|
while (1) {
|
||||||
Page_Run();
|
Page_Run();
|
||||||
jj_bt_run();
|
// by_buzzer_run();
|
||||||
queue_pop_read();
|
by_tiny_frame_write(0x0D, 0x0000, tiny_frame_param[0].u32);
|
||||||
|
by_tiny_frame_run();
|
||||||
|
system_delay_ms(10);
|
||||||
if (mt9v03x_finish_flag) {
|
if (mt9v03x_finish_flag) {
|
||||||
// 该操作消耗大概 1970 个 tick，折合约 110us
|
// 该操作消耗大概 1970 个 tick，折合约 110us
|
||||||
memcpy(mt9v03x_image_copy[0], mt9v03x_image[0], (sizeof(mt9v03x_image_copy) / sizeof(uint8_t)));
|
memcpy(mt9v03x_image_copy[0], mt9v03x_image[0], (sizeof(mt9v03x_image_copy) / sizeof(uint8_t)));
|
||||||
|
// adaptiveThreshold((uint8_t*)mt9v03x_image_copy, (uint8_t*)mt9v03x_image_copy, 188, 120, 7, 17);
|
||||||
|
// ips200_show_gray_image(0, 0, mt9v03x_image_copy[0], MT9V03X_W, MT9V03X_H, MT9V03X_W, MT9V03X_H, 0);
|
||||||
mt9v03x_finish_flag = 0;
|
mt9v03x_finish_flag = 0;
|
||||||
state_type = COMMON_STATE;
|
by_led_info_blink();
|
||||||
img_processing();
|
// state_type = COMMON_STATE;
|
||||||
get_corners();
|
// img_processing();
|
||||||
aim_distance = COMMON_AIM;
|
// get_corners();
|
||||||
tracking();
|
// aim_distance = COMMON_AIM;
|
||||||
ElementJudge();
|
// tracking();
|
||||||
ElementRun();
|
// ElementJudge();
|
||||||
MidLineTrack();
|
// ElementRun();
|
||||||
ips200_show_float(0,180,pure_angle,2,2);
|
// MidLineTrack();
|
||||||
ips200_show_int(0, 200, track_type, 2);
|
|
||||||
ips200_show_int(0, 220, garage_type, 2);
|
|
||||||
ips200_show_int(0, 240, cross_type, 2);
|
|
||||||
ips200_show_int(0, 260, circle_type, 2);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@@ -1,6 +0,0 @@
|
|||||||
#ifndef MAIN_H
|
|
||||||
#define MAIN_H
|
|
||||||
|
|
||||||
#include "zf_common_headfile.h"
|
|
||||||
|
|
||||||
#endif // MAIN_H
|
|
||||||
@@ -1,12 +1,16 @@
|
|||||||
#include "page.h"
|
#include "page.h"
|
||||||
|
|
||||||
#include "by_rt_button.h"
|
#include "by_button.h"
|
||||||
|
|
||||||
PAGE_LIST pagelist[page_max];
|
PAGE_LIST pagelist[page_max];
|
||||||
static uint8_t page_busy = 0;
|
static uint8_t page_busy = 0;
|
||||||
static int8_t now_page = page_menu;
|
|
||||||
static int8_t new_page = page_menu;
|
static int8_t new_page = page_menu;
|
||||||
|
static int8_t now_page = page_menu;
|
||||||
|
|
||||||
|
int8_t Get_new_page(void)
|
||||||
|
{
|
||||||
|
return new_page;
|
||||||
|
}
|
||||||
/**
|
/**
|
||||||
* @brief 注册一个基本页面，包含一个初始化函数，循环函数，退出函数，事件函数
|
* @brief 注册一个基本页面，包含一个初始化函数，循环函数，退出函数，事件函数
|
||||||
* @param pageID: 页面编号
|
* @param pageID: 页面编号
|
||||||
@@ -17,11 +21,11 @@ static int8_t new_page = page_menu;
|
|||||||
* @param eventCallback: 事件函数回调
|
* @param eventCallback: 事件函数回调
|
||||||
* @retval 无
|
* @retval 无
|
||||||
*/
|
*/
|
||||||
void Page_Register(uint8_t pageID, char *pageText,
|
void Page_Register(uint8_t pageID,
|
||||||
CallbackFunction_t setupCallback, CallbackFunction_t loopCallback,
|
CallbackFunction_t setupCallback, CallbackFunction_t loopCallback,
|
||||||
CallbackFunction_t exitCallback, EventFunction_t eventCallback)
|
CallbackFunction_t exitCallback, EventFunction_t eventCallback)
|
||||||
{
|
{
|
||||||
pagelist[pageID].Text = pageText;
|
|
||||||
pagelist[pageID].SetupCallback = setupCallback;
|
pagelist[pageID].SetupCallback = setupCallback;
|
||||||
pagelist[pageID].LoopCallback = loopCallback;
|
pagelist[pageID].LoopCallback = loopCallback;
|
||||||
pagelist[pageID].ExitCallback = exitCallback;
|
pagelist[pageID].ExitCallback = exitCallback;
|
||||||
@@ -89,7 +93,7 @@ uint8_t Page_GetStatus(void)
|
|||||||
*/
|
*/
|
||||||
void Page_Run(void)
|
void Page_Run(void)
|
||||||
{
|
{
|
||||||
uint8_t temp_status = by_get_rb_status(); // 轮询旋钮状态
|
uint8_t temp_status = by_button_get_status(); // 轮询旋钮状态
|
||||||
if (temp_status) {
|
if (temp_status) {
|
||||||
pagelist[now_page].EventCallback(temp_status);
|
pagelist[now_page].EventCallback(temp_status);
|
||||||
}
|
}
|
||||||
@@ -123,9 +127,11 @@ void Page_Run(void)
|
|||||||
*/
|
*/
|
||||||
void Page_Init(void)
|
void Page_Init(void)
|
||||||
{
|
{
|
||||||
PAGE_REG(page_menu);
|
PAGE_REG(page_menu, "main");
|
||||||
PAGE_REG(page_rtcam);
|
PAGE_REG(page_rtcam, "rtcam");
|
||||||
PAGE_REG(page_param);
|
PAGE_REG(page_param1, "Param1");
|
||||||
|
PAGE_REG(page_param2, "param2");
|
||||||
|
PAGE_REG(page_dparam, "dparam");
|
||||||
// PAGE_REG(page_argv);
|
// PAGE_REG(page_argv);
|
||||||
// PAGE_REG(page_sys);
|
// PAGE_REG(page_sys);
|
||||||
// PAGE_REG(page_run);
|
// PAGE_REG(page_run);
|
||||||
|
|||||||
@@ -13,14 +13,16 @@
|
|||||||
|
|
||||||
#include "zf_common_headfile.h"
|
#include "zf_common_headfile.h"
|
||||||
|
|
||||||
#include "by_rt_button.h"
|
#include "by_button.h"
|
||||||
|
|
||||||
enum PageID {
|
enum PageID {
|
||||||
PAGE_NULL = -1,
|
PAGE_NULL = -1,
|
||||||
//......
|
//......
|
||||||
page_menu,
|
page_menu,
|
||||||
page_rtcam,
|
page_rtcam,
|
||||||
page_param,
|
page_param1,
|
||||||
|
page_param2,
|
||||||
|
page_dparam,
|
||||||
// page_argv,
|
// page_argv,
|
||||||
// page_sys,
|
// page_sys,
|
||||||
// page_run,
|
// page_run,
|
||||||
@@ -29,10 +31,10 @@ enum PageID {
|
|||||||
};
|
};
|
||||||
|
|
||||||
typedef enum page_event {
|
typedef enum page_event {
|
||||||
page_event_forward = rotate_button_forward,
|
page_event_forward = button_event_up,
|
||||||
page_event_backward = rotate_button_backward,
|
page_event_backward = button_event_down,
|
||||||
page_event_press_short = rotate_button_press_short,
|
page_event_press_short = button_event_center_sp,
|
||||||
page_event_press_long = rotate_button_press_long,
|
page_event_press_long = button_event_center_lp,
|
||||||
} page_event;
|
} page_event;
|
||||||
|
|
||||||
typedef void (*CallbackFunction_t)(void);
|
typedef void (*CallbackFunction_t)(void);
|
||||||
@@ -46,13 +48,15 @@ typedef struct {
|
|||||||
} PAGE_LIST;
|
} PAGE_LIST;
|
||||||
|
|
||||||
// 页面注册函数
|
// 页面注册函数
|
||||||
#define PAGE_REG(name)\
|
#define PAGE_REG(_name_, _text_) \
|
||||||
do { \
|
do { \
|
||||||
extern void PageRegister_##name(unsigned char pageID);\
|
extern void PageRegister_##_name_(unsigned char pageID); \
|
||||||
PageRegister_##name(name);\
|
PageRegister_##_name_(_name_); \
|
||||||
}while(0)
|
} while (0); \
|
||||||
|
pagelist[_name_].Text = _text_ ;
|
||||||
|
|
||||||
void Page_Register(uint8_t pageID, char *pageText,
|
|
||||||
|
void Page_Register(uint8_t pageID,
|
||||||
CallbackFunction_t setupCallback, CallbackFunction_t loopCallback,
|
CallbackFunction_t setupCallback, CallbackFunction_t loopCallback,
|
||||||
CallbackFunction_t exitCallback, EventFunction_t eventCallback);
|
CallbackFunction_t exitCallback, EventFunction_t eventCallback);
|
||||||
|
|
||||||
@@ -63,7 +67,7 @@ void Page_OpenCurrentPage(void);
|
|||||||
uint8_t Page_GetStatus(void);
|
uint8_t Page_GetStatus(void);
|
||||||
void Page_Run(void);
|
void Page_Run(void);
|
||||||
void Page_Init(void);
|
void Page_Init(void);
|
||||||
|
int8_t Get_new_page(void);
|
||||||
|
|
||||||
extern PAGE_LIST pagelist[page_max];
|
extern PAGE_LIST pagelist[page_max];
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
72
app/page/page_dparam.c
Normal file
72
app/page/page_dparam.c
Normal file
@@ -0,0 +1,72 @@
|
|||||||
|
#include "zf_common_headfile.h"
|
||||||
|
#include "page_ui_widget.h"
|
||||||
|
#include "page.h"
|
||||||
|
#include "jj_param.h"
|
||||||
|
// #define LINE_HEAD 1
|
||||||
|
// #define LINE_END 7
|
||||||
|
// static int8_t Curser = LINE_HEAD; // 定义光标位置
|
||||||
|
// static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
|
||||||
|
/***************************************************************************************
|
||||||
|
*
|
||||||
|
* 以下为页面模板函数
|
||||||
|
*
|
||||||
|
***************************************************************************************/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面初始化事件
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Setup()
|
||||||
|
{
|
||||||
|
ips200_clear();
|
||||||
|
// 显示参数名称
|
||||||
|
ips200_show_string(0, 0, "Dparam");
|
||||||
|
|
||||||
|
ips200_show_string(20, 18 + 2, (Param_Data[delta_x].text));
|
||||||
|
ips200_show_string(20, 18 + 20, (Param_Data[delta_y].text));
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面退出事件
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Exit()
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面循环执行的内容
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Loop()
|
||||||
|
{
|
||||||
|
// 刷新参数数值
|
||||||
|
ips200_show_float(90, 18 + 2, *((float *)(Param_Data[delta_x].p_data)), 4, 5);
|
||||||
|
ips200_show_float(90, 18 + 20, *((float *)(Param_Data[delta_x].p_data)), 4, 5);
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面事件
|
||||||
|
* @param btn:发出事件的按键
|
||||||
|
* @param event:事件编号
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Event(page_event event)
|
||||||
|
{
|
||||||
|
if (page_event_press_long == event) {
|
||||||
|
Page_Shift(page_menu);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面注册函数
|
||||||
|
*
|
||||||
|
* @param pageID
|
||||||
|
*/
|
||||||
|
void PageRegister_page_dparam(unsigned char pageID)
|
||||||
|
{
|
||||||
|
Page_Register(pageID, Setup, Loop, Exit, Event);
|
||||||
|
}
|
||||||
@@ -57,9 +57,9 @@ static void Event(page_event event)
|
|||||||
Curser_Last = Curser;
|
Curser_Last = Curser;
|
||||||
|
|
||||||
if (page_event_forward == event) {
|
if (page_event_forward == event) {
|
||||||
Curser--; // 光标上移
|
Curser++; // 光标上移
|
||||||
} else if (page_event_backward == event) {
|
} else if (page_event_backward == event) {
|
||||||
Curser++; // 光标下移
|
Curser--; // 光标下移
|
||||||
} else if (page_event_press_short == event) {
|
} else if (page_event_press_short == event) {
|
||||||
if (page_max > Curser && page_menu < Curser) {
|
if (page_max > Curser && page_menu < Curser) {
|
||||||
Page_Shift(Curser); // 切换到光标选中的页面
|
Page_Shift(Curser); // 切换到光标选中的页面
|
||||||
@@ -82,7 +82,7 @@ static void Event(page_event event)
|
|||||||
*/
|
*/
|
||||||
void PageRegister_page_menu(unsigned char pageID)
|
void PageRegister_page_menu(unsigned char pageID)
|
||||||
{
|
{
|
||||||
Page_Register(pageID, Text, Setup, Loop, Exit, Event);
|
Page_Register(pageID, Setup, Loop, Exit, Event);
|
||||||
}
|
}
|
||||||
|
|
||||||
/***************************************************************************************
|
/***************************************************************************************
|
||||||
|
|||||||
@@ -1,155 +0,0 @@
|
|||||||
#include "jj_param.h"
|
|
||||||
#include "page_ui_widget.h"
|
|
||||||
#include "page.h"
|
|
||||||
#include "math.h"
|
|
||||||
#define LINE_HEAD 0
|
|
||||||
#define LINE_END DATA_NUM - 2
|
|
||||||
static char Text[] = "RealTime Param";
|
|
||||||
int event_flag = 0;
|
|
||||||
int32_t index_power = 0;
|
|
||||||
static int8_t Curser = LINE_HEAD; // 定义光标位置
|
|
||||||
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
|
|
||||||
void param_set();
|
|
||||||
void param_printf();
|
|
||||||
void param_change(uint8_t index, int param_event);
|
|
||||||
/***************************************************************************************
|
|
||||||
*
|
|
||||||
* 以下为页面模板函数
|
|
||||||
*
|
|
||||||
***************************************************************************************/
|
|
||||||
/**
|
|
||||||
* @brief 页面初始化事件
|
|
||||||
* @param 无
|
|
||||||
* @retval 无
|
|
||||||
*/
|
|
||||||
static void Setup()
|
|
||||||
{
|
|
||||||
ips200_clear();
|
|
||||||
param_set();
|
|
||||||
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief 页面退出事件
|
|
||||||
* @param 无
|
|
||||||
* @retval 无
|
|
||||||
*/
|
|
||||||
static void Exit()
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief 页面循环执行的内容
|
|
||||||
* @param 无
|
|
||||||
* @retval 无
|
|
||||||
*/
|
|
||||||
static void Loop()
|
|
||||||
{
|
|
||||||
}
|
|
||||||
/**
|
|
||||||
* @brief 页面事件
|
|
||||||
* @param btn:发出事件的按键
|
|
||||||
* @param event:事件编号
|
|
||||||
* @retval 无
|
|
||||||
*/
|
|
||||||
static void Event(page_event event)
|
|
||||||
{
|
|
||||||
|
|
||||||
if (0 == event_flag) {
|
|
||||||
Curser_Last = Curser;
|
|
||||||
if (page_event_forward == event) {
|
|
||||||
Curser--; // 光标上移
|
|
||||||
} else if (page_event_backward == event) {
|
|
||||||
Curser++; // 光标下移
|
|
||||||
} else if (page_event_press_short == event) {
|
|
||||||
event_flag = 1; // 选中参数
|
|
||||||
Print_Curser(Curser, Curser_Last, RGB565_RED);
|
|
||||||
return;
|
|
||||||
} else if (page_event_press_long == event) {
|
|
||||||
jj_param_write();
|
|
||||||
Page_Shift(page_menu);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
if (Curser < LINE_HEAD) {
|
|
||||||
Curser = LINE_END;
|
|
||||||
} else if (Curser > LINE_END) {
|
|
||||||
Curser = LINE_HEAD;
|
|
||||||
}
|
|
||||||
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
|
||||||
} else if (1 == event_flag) {
|
|
||||||
param_change(Curser, event);
|
|
||||||
param_printf();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
/**
|
|
||||||
* @brief 页面注册函数
|
|
||||||
*
|
|
||||||
* @param pageID
|
|
||||||
*/
|
|
||||||
void PageRegister_page_param(unsigned char pageID)
|
|
||||||
{
|
|
||||||
Page_Register(pageID, Text, Setup, Loop, Exit, Event);
|
|
||||||
}
|
|
||||||
/**
|
|
||||||
* @brief 参数显示更新
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
void param_printf()
|
|
||||||
{
|
|
||||||
if (EINT32 == Param_Data[Curser].type)
|
|
||||||
ips200_show_int(50, Curser * 18 + 2, *((int32_t *)(Param_Data[Curser].p_data)), 5);
|
|
||||||
else if (EUINT32 == Param_Data[Curser].type)
|
|
||||||
ips200_show_uint(50, Curser * 18 + 2, *((uint32_t *)(Param_Data[Curser].p_data)), 5);
|
|
||||||
else if (EFLOAT == Param_Data[Curser].type)
|
|
||||||
ips200_show_float(50, Curser * 18 + 2, *((float *)(Param_Data[Curser].p_data)), 4, 5);
|
|
||||||
}
|
|
||||||
/**
|
|
||||||
* @brief 参数初始化显示
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
void param_set()
|
|
||||||
{
|
|
||||||
for (int16_t i = 0; i < DATA_NUM - 1; i++) {
|
|
||||||
ips200_show_string(10, i * 18 + 2, Param_Data[i].text);
|
|
||||||
if (Param_Data[i].type == EINT32)
|
|
||||||
ips200_show_int(50, i * 18 + 2, *((int32_t *)(Param_Data[i].p_data)), 5);
|
|
||||||
else if (Param_Data[i].type == EFLOAT)
|
|
||||||
ips200_show_float(50, i * 18 + 2, *((float *)(Param_Data[i].p_data)), 4, 5);
|
|
||||||
}
|
|
||||||
ips200_show_int(50, (DATA_NUM - 1) * 18 + 2, index_power, 5);
|
|
||||||
}
|
|
||||||
/**
|
|
||||||
* @brief 参数改变
|
|
||||||
*
|
|
||||||
* @param index 当前指针所指参数索引
|
|
||||||
* @param param_event 触发事件
|
|
||||||
*/
|
|
||||||
void param_change(uint8_t index, int param_event)
|
|
||||||
{
|
|
||||||
if (page_event_forward == param_event) {
|
|
||||||
if (Param_Data[Curser].type == EFLOAT) {
|
|
||||||
*((float *)(Param_Data[Curser].p_data)) += powf(10.0f, (float)index_power);
|
|
||||||
} else if (Param_Data[Curser].type == EINT32) {
|
|
||||||
*((int32_t *)(Param_Data[Curser].p_data)) += pow(10, index_power + 2);
|
|
||||||
} else if (Param_Data[Curser].type == EUINT32) {
|
|
||||||
*((uint32_t *)(Param_Data[Curser].p_data)) += pow(10, index_power + 2);
|
|
||||||
}
|
|
||||||
} else if (page_event_backward == param_event) {
|
|
||||||
if (Param_Data[index].type == EFLOAT) {
|
|
||||||
*((float *)(Param_Data[index].p_data)) -= powf(10.0f, (float)index_power);
|
|
||||||
} else if (Param_Data[index].type == EINT32) {
|
|
||||||
*((int32_t *)(Param_Data[index].p_data)) -= pow(10, index_power + 2);
|
|
||||||
} else if (Param_Data[index].type == EUINT32) {
|
|
||||||
*((uint32_t *)(Param_Data[index].p_data)) -= pow(10, index_power + 2);
|
|
||||||
}
|
|
||||||
} else if (page_event_press_short == param_event) {
|
|
||||||
index_power++;
|
|
||||||
if (index_power > 2) {
|
|
||||||
index_power = -2;
|
|
||||||
}
|
|
||||||
ips200_show_int(50, (DATA_NUM - 1) * 18 + 2, index_power, 5);
|
|
||||||
} else if (page_event_press_long == param_event) {
|
|
||||||
event_flag = 0; // 回归选择参数事件
|
|
||||||
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
@@ -5,8 +5,6 @@
|
|||||||
#define LINE_HEAD 11
|
#define LINE_HEAD 11
|
||||||
#define LINE_END 16
|
#define LINE_END 16
|
||||||
|
|
||||||
static char Text[] = "RealTime Image";
|
|
||||||
|
|
||||||
static int8_t Curser = LINE_HEAD; // 定义光标位置
|
static int8_t Curser = LINE_HEAD; // 定义光标位置
|
||||||
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
|
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
|
||||||
/***************************************************************************************
|
/***************************************************************************************
|
||||||
@@ -81,7 +79,7 @@ static void Event(page_event event)
|
|||||||
*/
|
*/
|
||||||
void PageRegister_page_rtcam(unsigned char pageID)
|
void PageRegister_page_rtcam(unsigned char pageID)
|
||||||
{
|
{
|
||||||
Page_Register(pageID, Text, Setup, Loop, Exit, Event);
|
Page_Register(pageID, Setup, Loop, Exit, Event);
|
||||||
}
|
}
|
||||||
|
|
||||||
/***************************************************************************************
|
/***************************************************************************************
|
||||||
|
|||||||
160
app/page/page_sparam1.c
Normal file
160
app/page/page_sparam1.c
Normal file
@@ -0,0 +1,160 @@
|
|||||||
|
#include "jj_param.h"
|
||||||
|
#include "page_ui_widget.h"
|
||||||
|
#include "page.h"
|
||||||
|
#include <math.h>
|
||||||
|
|
||||||
|
#define LINE_HEAD 1
|
||||||
|
|
||||||
|
static int16 pafrist;
|
||||||
|
static int16 paend;
|
||||||
|
static int16 palong;
|
||||||
|
static int event_flag = 0;
|
||||||
|
static int32_t index_power = 0;
|
||||||
|
static int8_t Curser = LINE_HEAD; // 定义光标位置
|
||||||
|
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
|
||||||
|
/***************************************************************************************
|
||||||
|
*
|
||||||
|
* 以下为页面模板函数
|
||||||
|
*
|
||||||
|
***************************************************************************************/
|
||||||
|
/**
|
||||||
|
* @brief 页面初始化事件
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Setup()
|
||||||
|
{
|
||||||
|
ips200_clear();
|
||||||
|
|
||||||
|
if (Get_new_page() == page_param1) {
|
||||||
|
pafrist = 0;
|
||||||
|
paend = Page2_head;
|
||||||
|
ips200_show_string(0, 0, "Param1");
|
||||||
|
} else if (Get_new_page() == page_param2) {
|
||||||
|
pafrist = Page2_head;
|
||||||
|
paend = Page3_head;
|
||||||
|
ips200_show_string(0, 0, "Param2");
|
||||||
|
}
|
||||||
|
|
||||||
|
palong = paend - pafrist;
|
||||||
|
if (Curser < LINE_HEAD) {
|
||||||
|
Curser = palong;
|
||||||
|
} else if (Curser > palong) {
|
||||||
|
Curser = LINE_HEAD;
|
||||||
|
}
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
||||||
|
for (int16 i = 0; i < palong; i++) {
|
||||||
|
ips200_show_string(20, i * 18 + 20, Param_Data[i + pafrist].text);
|
||||||
|
if (Param_Data[i].type == EINT32)
|
||||||
|
ips200_show_int(60, i * 18 + 20, *((int32 *)(Param_Data[i + pafrist].p_data)), 5);
|
||||||
|
else if (Param_Data[i].type == EFLOAT)
|
||||||
|
ips200_show_float(60, i * 18 + 20, *((float *)(Param_Data[i + pafrist].p_data)), 4, 5);
|
||||||
|
}
|
||||||
|
ips200_show_int(50, palong * 18 + 20, index_power, 5);
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面退出事件
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Exit()
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面循环执行的内容
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Loop()
|
||||||
|
{
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* @brief 页面事件
|
||||||
|
* @param btn:发出事件的按键
|
||||||
|
* @param event:事件编号
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Event(page_event event)
|
||||||
|
{
|
||||||
|
|
||||||
|
if (0 == event_flag) {
|
||||||
|
|
||||||
|
Curser_Last = Curser;
|
||||||
|
if (page_event_forward == event) {
|
||||||
|
Curser++; // 光标上移
|
||||||
|
} else if (page_event_backward == event) {
|
||||||
|
Curser--; // 光标下移
|
||||||
|
} else if (page_event_press_short == event) {
|
||||||
|
event_flag = 1; // 选中参数
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_RED);
|
||||||
|
return;
|
||||||
|
} else if (page_event_press_long == event) {
|
||||||
|
jj_param_write();
|
||||||
|
Page_Shift(page_menu);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if (Curser < LINE_HEAD) {
|
||||||
|
Curser = palong;
|
||||||
|
} else if (Curser > palong) {
|
||||||
|
Curser = LINE_HEAD;
|
||||||
|
}
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
||||||
|
} else if (1 == event_flag) {
|
||||||
|
if (page_event_forward == event) {
|
||||||
|
switch (Param_Data[Curser + pafrist - 1].type) {
|
||||||
|
case EFLOAT:
|
||||||
|
*((float *)(Param_Data[Curser + pafrist - 1].p_data)) += powf(10, index_power);
|
||||||
|
break;
|
||||||
|
case EINT32:
|
||||||
|
*((int32 *)(Param_Data[Curser + pafrist - 1].p_data)) += 1;
|
||||||
|
break;
|
||||||
|
case EUINT32:
|
||||||
|
*((uint32 *)(Param_Data[Curser + pafrist - 1].p_data)) += 1;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} else if (page_event_backward == event) {
|
||||||
|
switch (Param_Data[Curser + pafrist - 1].type) {
|
||||||
|
case EFLOAT:
|
||||||
|
*((float *)(Param_Data[Curser + pafrist - 1].p_data)) -= powf(10.0f, (float)index_power);
|
||||||
|
break;
|
||||||
|
case EINT32:
|
||||||
|
*((int32 *)(Param_Data[Curser + pafrist - 1].p_data)) -= 1;
|
||||||
|
break;
|
||||||
|
case EUINT32:
|
||||||
|
*((uint32 *)(Param_Data[Curser + pafrist - 1].p_data)) -= 1;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} else if (page_event_press_short == event) {
|
||||||
|
index_power++;
|
||||||
|
if (index_power > 2) {
|
||||||
|
index_power = -2;
|
||||||
|
}
|
||||||
|
ips200_show_int(50, palong * 18 + 20, index_power, 5);
|
||||||
|
} else if (page_event_press_long == event) {
|
||||||
|
event_flag = 0;
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
||||||
|
}
|
||||||
|
if (EINT32 == Param_Data[Curser + pafrist - 1].type)
|
||||||
|
ips200_show_int(60, Curser * 18 + 2, *((int32 *)(Param_Data[Curser + pafrist - 1].p_data)), 5);
|
||||||
|
else if (EUINT32 == Param_Data[Curser + pafrist - 1].type)
|
||||||
|
ips200_show_uint(60, Curser * 18 + 2, *((int32 *)(Param_Data[Curser + pafrist - 1].p_data)), 5);
|
||||||
|
else if (EFLOAT == Param_Data[Curser + pafrist - 1].type)
|
||||||
|
ips200_show_float(60, Curser * 18 + 2, *((float *)(Param_Data[Curser + pafrist - 1].p_data)), 4, 5);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面注册函数
|
||||||
|
*
|
||||||
|
* @param pageID
|
||||||
|
*/
|
||||||
|
void PageRegister_page_param1(unsigned char pageID)
|
||||||
|
{
|
||||||
|
Page_Register(pageID, Setup, Loop, Exit, Event);
|
||||||
|
}
|
||||||
160
app/page/page_sparam2.c
Normal file
160
app/page/page_sparam2.c
Normal file
@@ -0,0 +1,160 @@
|
|||||||
|
#include "jj_param.h"
|
||||||
|
#include "page_ui_widget.h"
|
||||||
|
#include "page.h"
|
||||||
|
#include <math.h>
|
||||||
|
|
||||||
|
#define LINE_HEAD 1
|
||||||
|
|
||||||
|
static int16 pafrist;
|
||||||
|
static int16 paend;
|
||||||
|
static int16 palong;
|
||||||
|
static int event_flag = 0;
|
||||||
|
static int32_t index_power = 0;
|
||||||
|
static int8_t Curser = LINE_HEAD; // 定义光标位置
|
||||||
|
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
|
||||||
|
/***************************************************************************************
|
||||||
|
*
|
||||||
|
* 以下为页面模板函数
|
||||||
|
*
|
||||||
|
***************************************************************************************/
|
||||||
|
/**
|
||||||
|
* @brief 页面初始化事件
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Setup()
|
||||||
|
{
|
||||||
|
ips200_clear();
|
||||||
|
|
||||||
|
if (Get_new_page() == page_param1) {
|
||||||
|
pafrist = 0;
|
||||||
|
paend = Page2_head;
|
||||||
|
ips200_show_string(0, 0, "Param1");
|
||||||
|
} else if (Get_new_page() == page_param2) {
|
||||||
|
pafrist = Page2_head;
|
||||||
|
paend = Page3_head;
|
||||||
|
ips200_show_string(0, 0, "Param2");
|
||||||
|
}
|
||||||
|
|
||||||
|
palong = paend - pafrist;
|
||||||
|
if (Curser < LINE_HEAD) {
|
||||||
|
Curser = palong;
|
||||||
|
} else if (Curser > palong) {
|
||||||
|
Curser = LINE_HEAD;
|
||||||
|
}
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
||||||
|
for (int16 i = 0; i < palong; i++) {
|
||||||
|
ips200_show_string(20, i * 18 + 20, Param_Data[i + pafrist].text);
|
||||||
|
if (Param_Data[i].type == EINT32)
|
||||||
|
ips200_show_int(60, i * 18 + 20, *((int32 *)(Param_Data[i + pafrist].p_data)), 5);
|
||||||
|
else if (Param_Data[i].type == EFLOAT)
|
||||||
|
ips200_show_float(60, i * 18 + 20, *((float *)(Param_Data[i + pafrist].p_data)), 4, 5);
|
||||||
|
}
|
||||||
|
ips200_show_int(50, palong * 18 + 20, index_power, 5);
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面退出事件
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Exit()
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面循环执行的内容
|
||||||
|
* @param 无
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Loop()
|
||||||
|
{
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* @brief 页面事件
|
||||||
|
* @param btn:发出事件的按键
|
||||||
|
* @param event:事件编号
|
||||||
|
* @retval 无
|
||||||
|
*/
|
||||||
|
static void Event(page_event event)
|
||||||
|
{
|
||||||
|
|
||||||
|
if (0 == event_flag) {
|
||||||
|
|
||||||
|
Curser_Last = Curser;
|
||||||
|
if (page_event_forward == event) {
|
||||||
|
Curser++; // 光标上移
|
||||||
|
} else if (page_event_backward == event) {
|
||||||
|
Curser--; // 光标下移
|
||||||
|
} else if (page_event_press_short == event) {
|
||||||
|
event_flag = 1; // 选中参数
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_RED);
|
||||||
|
return;
|
||||||
|
} else if (page_event_press_long == event) {
|
||||||
|
jj_param_write();
|
||||||
|
Page_Shift(page_menu);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if (Curser < LINE_HEAD) {
|
||||||
|
Curser = palong;
|
||||||
|
} else if (Curser > palong) {
|
||||||
|
Curser = LINE_HEAD;
|
||||||
|
}
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
||||||
|
} else if (1 == event_flag) {
|
||||||
|
if (page_event_forward == event) {
|
||||||
|
switch (Param_Data[Curser + pafrist - 1].type) {
|
||||||
|
case EFLOAT:
|
||||||
|
*((float *)(Param_Data[Curser + pafrist - 1].p_data)) += powf(10, index_power);
|
||||||
|
break;
|
||||||
|
case EINT32:
|
||||||
|
*((int32 *)(Param_Data[Curser + pafrist - 1].p_data)) += 1;
|
||||||
|
break;
|
||||||
|
case EUINT32:
|
||||||
|
*((uint32 *)(Param_Data[Curser + pafrist - 1].p_data)) += 1;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} else if (page_event_backward == event) {
|
||||||
|
switch (Param_Data[Curser + pafrist - 1].type) {
|
||||||
|
case EFLOAT:
|
||||||
|
*((float *)(Param_Data[Curser + pafrist - 1].p_data)) -= powf(10.0f, (float)index_power);
|
||||||
|
break;
|
||||||
|
case EINT32:
|
||||||
|
*((int32 *)(Param_Data[Curser + pafrist - 1].p_data)) -= 1;
|
||||||
|
break;
|
||||||
|
case EUINT32:
|
||||||
|
*((uint32 *)(Param_Data[Curser + pafrist - 1].p_data)) -= 1;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} else if (page_event_press_short == event) {
|
||||||
|
index_power++;
|
||||||
|
if (index_power > 2) {
|
||||||
|
index_power = -2;
|
||||||
|
}
|
||||||
|
ips200_show_int(50, palong * 18 + 20, index_power, 5);
|
||||||
|
} else if (page_event_press_long == event) {
|
||||||
|
event_flag = 0;
|
||||||
|
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
|
||||||
|
}
|
||||||
|
if (EINT32 == Param_Data[Curser + pafrist - 1].type)
|
||||||
|
ips200_show_int(60, Curser * 18 + 2, *((int32 *)(Param_Data[Curser + pafrist - 1].p_data)), 5);
|
||||||
|
else if (EUINT32 == Param_Data[Curser + pafrist - 1].type)
|
||||||
|
ips200_show_uint(60, Curser * 18 + 2, *((int32 *)(Param_Data[Curser + pafrist - 1].p_data)), 5);
|
||||||
|
else if (EFLOAT == Param_Data[Curser + pafrist - 1].type)
|
||||||
|
ips200_show_float(60, Curser * 18 + 2, *((float *)(Param_Data[Curser + pafrist - 1].p_data)), 4, 5);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief 页面注册函数
|
||||||
|
*
|
||||||
|
* @param pageID
|
||||||
|
*/
|
||||||
|
void PageRegister_page_param2(unsigned char pageID)
|
||||||
|
{
|
||||||
|
Page_Register(pageID, Setup, Loop, Exit, Event);
|
||||||
|
}
|
||||||
38
app/tiny_frame/by_tiny_frame.c
Normal file
38
app/tiny_frame/by_tiny_frame.c
Normal file
@@ -0,0 +1,38 @@
|
|||||||
|
#include "by_tiny_frame.h"
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include "crc16.h"
|
||||||
|
#include "zf_common_headfile.h"
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
#include "by_tiny_frame_master_read.h"
|
||||||
|
#include "by_tiny_frame_master_write.h"
|
||||||
|
#include "by_tiny_frame_slave_read_write.h"
|
||||||
|
|
||||||
|
void by_tiny_frame_init(void)
|
||||||
|
{
|
||||||
|
/*** 初始化相关外设 ***/
|
||||||
|
uart_init(BY_TF_UART_INDEX, BY_TF_UART_BAUDRATE, BY_TF_UART_TX_PIN, BY_TF_UART_RX_PIN);
|
||||||
|
uart_rx_interrupt(BY_TF_UART_INDEX, ENABLE);
|
||||||
|
|
||||||
|
by_tiny_frame_parse_init();
|
||||||
|
by_tiny_frame_pack_init();
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
by_tiny_frame_parse_handle_register(by_tiny_frame_read_write_handle);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_run(void)
|
||||||
|
{
|
||||||
|
by_tiny_frame_parse_run();
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
by_tiny_frame_read_run();
|
||||||
|
by_tiny_frame_write_run();
|
||||||
|
#elif defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
by_tiny_frame_read_write_run();
|
||||||
|
#endif
|
||||||
|
}
|
||||||
16
app/tiny_frame/by_tiny_frame.h
Normal file
16
app/tiny_frame/by_tiny_frame.h
Normal file
@@ -0,0 +1,16 @@
|
|||||||
|
#ifndef _BY_TINY_FRAME_H__
|
||||||
|
#define _BY_TINY_FRAME_H__
|
||||||
|
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
#include "by_tiny_frame_master_read.h"
|
||||||
|
#include "by_tiny_frame_master_write.h"
|
||||||
|
#elif defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
#include "by_tiny_frame_slave_read_write.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
|
extern void by_tiny_frame_init(void);
|
||||||
|
void by_tiny_frame_run(void);
|
||||||
|
|
||||||
|
#endif
|
||||||
27
app/tiny_frame/by_tiny_frame_config.h
Normal file
27
app/tiny_frame/by_tiny_frame_config.h
Normal file
@@ -0,0 +1,27 @@
|
|||||||
|
#ifndef _BY_TINY_FRAME_CONFIG_H__
|
||||||
|
#define _BY_TINY_FRAME_CONFIG_H__
|
||||||
|
|
||||||
|
#define BY_TF_DEBUG (1)
|
||||||
|
|
||||||
|
#define BY_TF_UART_TX_PIN (UART2_MAP0_TX_A2)
|
||||||
|
#define BY_TF_UART_RX_PIN (UART2_MAP0_RX_A3)
|
||||||
|
#define BY_TF_UART_INDEX (UART_2)
|
||||||
|
#define BY_TF_UART_BAUDRATE (115200)
|
||||||
|
|
||||||
|
#define BY_TF_PARSE_BUFFER_SIZE (50)
|
||||||
|
|
||||||
|
// 注释此项则为主机，否则为从机
|
||||||
|
// #define BY_TF_DEVICE_SLAVE
|
||||||
|
|
||||||
|
/********** 从机模式配置选项 **********/
|
||||||
|
#if defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
// 从机地址 (多从机通信时注意修改地址，避免冲突)
|
||||||
|
#define BY_TF_DEVICE_SLAVE_ADDRESS (0x0D)
|
||||||
|
/********** 主机模式配置选项 **********/
|
||||||
|
#else
|
||||||
|
#define BY_TF_DEVICE_MASTER
|
||||||
|
// 监听/解析 超时时间 单位毫秒
|
||||||
|
#define BY_TF_PARSE_TIMEOUT (200)
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
57
app/tiny_frame/by_tiny_frame_master_read.c
Normal file
57
app/tiny_frame/by_tiny_frame_master_read.c
Normal file
@@ -0,0 +1,57 @@
|
|||||||
|
#include "by_tiny_frame_master_read.h"
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
|
||||||
|
uint32_t *data_p;
|
||||||
|
|
||||||
|
void by_tiny_frame_read_run(void)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_read(uint8_t slave_id, uint16_t reg_addr, uint32_t *data)
|
||||||
|
{
|
||||||
|
if (by_tiny_frame_pack_lock) {
|
||||||
|
// 写入忙处理
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 填充数据
|
||||||
|
by_tf_pack_frame_t frame_s;
|
||||||
|
frame_s.slave_id = slave_id;
|
||||||
|
frame_s.cmd = BY_TINY_FRAME_READ_CMD_CODE;
|
||||||
|
frame_s.reg_addr = reg_addr;
|
||||||
|
frame_s.data = 0;
|
||||||
|
|
||||||
|
// 发送写请求
|
||||||
|
by_tiny_frame_pack_send(&frame_s);
|
||||||
|
// 设置响应监听 id
|
||||||
|
by_tiny_frame_parse_set_listen_slave_id(slave_id);
|
||||||
|
// 注册响应监听回调
|
||||||
|
by_tiny_frame_parse_handle_register(by_tiny_frame_read_handle);
|
||||||
|
// 开启响应监听
|
||||||
|
by_tiny_frame_parse_start_listen();
|
||||||
|
|
||||||
|
by_tiny_frame_pack_lock = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_read_handle(by_tf_parse_frame_t frame_s, uint8_t status)
|
||||||
|
{
|
||||||
|
|
||||||
|
by_tiny_frame_pack_lock = 0;
|
||||||
|
if (!status) {
|
||||||
|
*data_p = frame_s.data;
|
||||||
|
}
|
||||||
|
|
||||||
|
#if (BY_TF_DEBUG)
|
||||||
|
printf("****** READ REGISTER DONE ******\r\n");
|
||||||
|
printf("SLAVE ID: 0x%0.2X\r\n", frame_s.frame[0]);
|
||||||
|
printf("\t--cmd: %0.2X\n\t--reg_addr: 0x%0.4X\n\t--data: 0x%0.8X\r\n", frame_s.cmd, frame_s.reg_addr, frame_s.data);
|
||||||
|
if (status) {
|
||||||
|
printf("read operation failed!!!\r\n");
|
||||||
|
} else {
|
||||||
|
printf("read operation successful!!!\r\n");
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
18
app/tiny_frame/by_tiny_frame_master_read.h
Normal file
18
app/tiny_frame/by_tiny_frame_master_read.h
Normal file
@@ -0,0 +1,18 @@
|
|||||||
|
#ifndef _BY_TINY_FRAME_MASTER_READ_H__
|
||||||
|
#define _BY_TINY_FRAME_MASTER_READ_H__
|
||||||
|
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
#include "by_tiny_frame_pack.h"
|
||||||
|
|
||||||
|
#define BY_TINY_FRAME_READ_CMD_CODE (0x03)
|
||||||
|
|
||||||
|
extern void by_tiny_frame_read(uint8_t slave_id, uint16_t reg_addr, uint32_t *data);
|
||||||
|
extern void by_tiny_frame_read_run(void);
|
||||||
|
extern void by_tiny_frame_read_handle(by_tf_parse_frame_t frame_s, uint8_t status);
|
||||||
|
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
57
app/tiny_frame/by_tiny_frame_master_write.c
Normal file
57
app/tiny_frame/by_tiny_frame_master_write.c
Normal file
@@ -0,0 +1,57 @@
|
|||||||
|
#include "by_tiny_frame_master_write.h"
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
|
||||||
|
#include "by_tiny_frame_pack.h"
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
|
||||||
|
void by_tiny_frame_write_run(void)
|
||||||
|
{
|
||||||
|
// nothing
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_write(uint8_t slave_id, uint16_t reg_addr, uint32_t data)
|
||||||
|
{
|
||||||
|
if(by_tiny_frame_pack_lock){
|
||||||
|
//写入忙处理
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 填充数据
|
||||||
|
by_tf_pack_frame_t frame_s;
|
||||||
|
frame_s.slave_id = slave_id;
|
||||||
|
frame_s.cmd = BY_TINY_FRAME_WRITE_CMD_CODE;
|
||||||
|
frame_s.reg_addr = reg_addr;
|
||||||
|
frame_s.data = data;
|
||||||
|
|
||||||
|
// 发送写请求
|
||||||
|
by_tiny_frame_pack_send(&frame_s);
|
||||||
|
// 设置响应监听 id
|
||||||
|
by_tiny_frame_parse_set_listen_slave_id(slave_id);
|
||||||
|
// 注册响应监听回调
|
||||||
|
by_tiny_frame_parse_handle_register(by_tiny_frame_write_handle);
|
||||||
|
// 开启响应监听
|
||||||
|
by_tiny_frame_parse_start_listen();
|
||||||
|
|
||||||
|
by_tiny_frame_pack_lock = 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_write_handle(by_tf_parse_frame_t frame_s, uint8_t status)
|
||||||
|
{
|
||||||
|
by_tiny_frame_pack_lock = 0;
|
||||||
|
|
||||||
|
#if (BY_TF_DEBUG)
|
||||||
|
printf("****** WRITE REGISTER DONE ******\r\n");
|
||||||
|
printf("SLAVE ID: 0x%0.2X\r\n", frame_s.frame[0]);
|
||||||
|
printf("\t--cmd: %0.2X\n\t--reg_addr: 0x%0.4X\n\t--data: 0x%0.8X\r\n", frame_s.cmd, frame_s.reg_addr, frame_s.data);
|
||||||
|
if (status) {
|
||||||
|
printf("write operation failed!!!\r\n");
|
||||||
|
|
||||||
|
} else {
|
||||||
|
printf("write operation successful!!!\r\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
18
app/tiny_frame/by_tiny_frame_master_write.h
Normal file
18
app/tiny_frame/by_tiny_frame_master_write.h
Normal file
@@ -0,0 +1,18 @@
|
|||||||
|
#ifndef _BY_TINY_FRAME_MASTER_WRITE_H__
|
||||||
|
#define _BY_TINY_FRAME_MASTER_WRITE_H__
|
||||||
|
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
#include "by_tiny_frame_pack.h"
|
||||||
|
|
||||||
|
#define BY_TINY_FRAME_WRITE_CMD_CODE (0x06)
|
||||||
|
|
||||||
|
extern void by_tiny_frame_write(uint8_t slave_id, uint16_t reg_addr, uint32_t data);
|
||||||
|
extern void by_tiny_frame_write_run(void);
|
||||||
|
extern void by_tiny_frame_write_handle(by_tf_parse_frame_t frame_s, uint8_t status);
|
||||||
|
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
42
app/tiny_frame/by_tiny_frame_pack.c
Normal file
42
app/tiny_frame/by_tiny_frame_pack.c
Normal file
@@ -0,0 +1,42 @@
|
|||||||
|
#include "by_tiny_frame_pack.h"
|
||||||
|
|
||||||
|
#include <string.h>
|
||||||
|
#include "zf_common_headfile.h"
|
||||||
|
#include "crc16.h"
|
||||||
|
|
||||||
|
uint8_t by_tiny_frame_pack_lock;
|
||||||
|
|
||||||
|
void by_tiny_frame_pack_init(void)
|
||||||
|
{
|
||||||
|
/** nothing to init **/
|
||||||
|
by_tiny_frame_pack_lock = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_pack_send(by_tf_pack_frame_t *frame_s)
|
||||||
|
{
|
||||||
|
uint16_t calc_crc_val = 0;
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
frame_s->frame[0] = ((frame_s->slave_id << 1) + 1);
|
||||||
|
#else
|
||||||
|
frame_s->frame[0] = (frame_s->slave_id << 1);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
// 填充指令段
|
||||||
|
frame_s->frame[1] = frame_s->cmd;
|
||||||
|
// 填充寄存器地址段
|
||||||
|
frame_s->frame[2] = (uint8_t)((frame_s->reg_addr >> 8) & 0xFF);
|
||||||
|
frame_s->frame[3] = (uint8_t)(frame_s->reg_addr & 0xFF);
|
||||||
|
// 填充数据段
|
||||||
|
frame_s->frame[4] = (uint8_t)((frame_s->data >> 24) & 0xFF);
|
||||||
|
frame_s->frame[5] = (uint8_t)((frame_s->data >> 16) & 0xFF);
|
||||||
|
frame_s->frame[6] = (uint8_t)((frame_s->data >> 8) & 0xFF);
|
||||||
|
frame_s->frame[7] = (uint8_t)(frame_s->data & 0xFF);
|
||||||
|
// 填充 CRC 段
|
||||||
|
calc_crc_val = crc16_check(frame_s->frame, (sizeof(frame_s->frame) - 2));
|
||||||
|
frame_s->frame[8] = (uint8_t)((calc_crc_val >> 8) & 0xFF);
|
||||||
|
frame_s->frame[9] = (uint8_t)(calc_crc_val & 0xFF);
|
||||||
|
|
||||||
|
/** 从串口发送 **/
|
||||||
|
uart_write_buffer(BY_TF_UART_INDEX, frame_s->frame, sizeof(frame_s->frame));
|
||||||
|
}
|
||||||
26
app/tiny_frame/by_tiny_frame_pack.h
Normal file
26
app/tiny_frame/by_tiny_frame_pack.h
Normal file
@@ -0,0 +1,26 @@
|
|||||||
|
#ifndef _BY_TINY_FRAME_PACK_H__
|
||||||
|
#define _BY_TINY_FRAME_PACK_H__
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
|
||||||
|
// 从机地址 (1b) - 功能码 (1b) - 寄存器地址 (2b) - 数据 (4b) - CRC(2b)
|
||||||
|
// 从机地址 (1b) 0-127, 最低位表示发送方，主机请求低位为 0，从机应答低位为 1
|
||||||
|
// 高字节在前
|
||||||
|
|
||||||
|
typedef struct by_tf_pack_frame_t {
|
||||||
|
uint8_t frame[10];
|
||||||
|
uint8_t slave_id;
|
||||||
|
uint8_t cmd;
|
||||||
|
uint16_t reg_addr;
|
||||||
|
uint32_t data;
|
||||||
|
} by_tf_pack_frame_t;
|
||||||
|
|
||||||
|
extern void by_tiny_frame_pack_init(void);
|
||||||
|
extern void by_tiny_frame_pack_send(by_tf_pack_frame_t *frame_s);
|
||||||
|
|
||||||
|
extern uint8_t by_tiny_frame_pack_lock;
|
||||||
|
|
||||||
|
#endif
|
||||||
198
app/tiny_frame/by_tiny_frame_parse.c
Normal file
198
app/tiny_frame/by_tiny_frame_parse.c
Normal file
@@ -0,0 +1,198 @@
|
|||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
|
||||||
|
#include "crc16.h"
|
||||||
|
#include "lwrb.h"
|
||||||
|
|
||||||
|
lwrb_t lwrb_struct;
|
||||||
|
uint8_t buffer_rb[BY_TF_PARSE_BUFFER_SIZE];
|
||||||
|
uint8_t buffer_out;
|
||||||
|
uint8_t listen_slave_id;
|
||||||
|
uint8_t listen_flag;
|
||||||
|
uint16_t listen_timeout;
|
||||||
|
uint16_t listen_timevia;
|
||||||
|
by_tf_parse_frame_t frame_now;
|
||||||
|
by_tf_parse_done_handle_func parse_done_handle;
|
||||||
|
|
||||||
|
void by_tiny_frame_parse_init(void)
|
||||||
|
{
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
listen_timeout = BY_TF_PARSE_TIMEOUT;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/** 初始化环形缓冲区 **/
|
||||||
|
lwrb_init(&lwrb_struct, buffer_rb, 40);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t by_tiny_frame_parse_listening(by_tf_parse_frame_t *frame_s, const uint8_t slave_id, const uint8_t buff)
|
||||||
|
{
|
||||||
|
|
||||||
|
static uint8_t cnt_s = 0;
|
||||||
|
static uint8_t cnt_rest_s = 0;
|
||||||
|
|
||||||
|
#if (BY_TF_DEBUG)
|
||||||
|
printf("%0.2X\r\n", buff);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
do {
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
if ((0 == cnt_s) && ((slave_id << 1) == buff)) {
|
||||||
|
#else
|
||||||
|
if ((0 == cnt_s) && (((slave_id << 1) + 1) == buff)) {
|
||||||
|
#endif
|
||||||
|
memset(frame_s, 0, sizeof(*frame_s));
|
||||||
|
cnt_s = 1;
|
||||||
|
cnt_rest_s = 9;
|
||||||
|
frame_s->frame[0] = buff;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (1 <= cnt_s) {
|
||||||
|
frame_s->frame[cnt_s] = buff;
|
||||||
|
cnt_s++;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 == --cnt_rest_s) {
|
||||||
|
cnt_s = 0;
|
||||||
|
|
||||||
|
frame_s->cmd = frame_s->frame[1];
|
||||||
|
frame_s->reg_addr |= ((uint16_t)frame_s->frame[2] << 8);
|
||||||
|
frame_s->reg_addr |= (uint16_t)frame_s->frame[3];
|
||||||
|
frame_s->data |= ((uint32_t)frame_s->frame[4] << 24);
|
||||||
|
frame_s->data |= ((uint32_t)frame_s->frame[5] << 16);
|
||||||
|
frame_s->data |= ((uint32_t)frame_s->frame[6] << 8);
|
||||||
|
frame_s->data |= (uint32_t)frame_s->frame[7];
|
||||||
|
frame_s->crc_val |= ((uint16_t)frame_s->frame[8] << 8);
|
||||||
|
frame_s->crc_val |= (uint16_t)frame_s->frame[9];
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
} while (0);
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief by_tf_parse 串口回调函数，在对应串口中断函数中调用
|
||||||
|
*
|
||||||
|
* @param buff
|
||||||
|
*/
|
||||||
|
void by_tiny_frame_parse_uart_handle(uint8_t buff)
|
||||||
|
{
|
||||||
|
lwrb_write(&lwrb_struct, &buff, 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief by_tf_parse 定时回调函数，要求触发周期为 1ms
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
void by_tiny_frame_parse_timer_handle(void)
|
||||||
|
{
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
if (listen_flag) {
|
||||||
|
listen_timevia++;
|
||||||
|
} else {
|
||||||
|
listen_timevia = 0;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
void by_tiny_frame_parse_run(void)
|
||||||
|
{
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_MASTER)
|
||||||
|
if (0 == listen_flag) {
|
||||||
|
return;
|
||||||
|
} else {
|
||||||
|
if (listen_timeout <= listen_timevia) {
|
||||||
|
// 接收超时，停止监听
|
||||||
|
parse_done_handle(frame_now, 1);
|
||||||
|
by_tiny_frame_parse_end_listen();
|
||||||
|
#if (BY_TF_DEBUG)
|
||||||
|
printf("by_tf_listen timeout\r\n");
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
for (uint8_t i = 0; i < lwrb_get_full(&lwrb_struct); i++) {
|
||||||
|
|
||||||
|
if (!lwrb_read(&lwrb_struct, &buffer_out, 1)) {
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
// TODO 目前接收校验错误也会等待直至超时
|
||||||
|
// TODO 待结合 read&wirte 部分修改监听的从机地址
|
||||||
|
#if defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
if (!by_tiny_frame_parse_listening(&frame_now, BY_TF_DEVICE_SLAVE_ADDRESS, buffer_out))
|
||||||
|
#else
|
||||||
|
if (!by_tiny_frame_parse_listening(&frame_now, listen_slave_id, buffer_out))
|
||||||
|
#endif
|
||||||
|
{
|
||||||
|
if (!by_tiny_frame_parse_crc(&frame_now)) {
|
||||||
|
|
||||||
|
// 接收成功后停止监听
|
||||||
|
by_tiny_frame_parse_end_listen();
|
||||||
|
// 解析成功回调
|
||||||
|
parse_done_handle(frame_now, 0);
|
||||||
|
#if (BY_TF_DEBUG)
|
||||||
|
printf("frame parsed!\r\n");
|
||||||
|
#endif
|
||||||
|
// 解析帧
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// if (!mp_cmd_parse_modbus_handle(data)) {
|
||||||
|
// mp_cmd_mb_parse(&mp_cmd_mb_now, &mp_cmd_parsed_now);
|
||||||
|
// }
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t by_tiny_frame_parse_crc(by_tf_parse_frame_t *frame_s)
|
||||||
|
{
|
||||||
|
uint16_t calc_crc_val = 0;
|
||||||
|
|
||||||
|
calc_crc_val = crc16_check(frame_s->frame, (sizeof(frame_s->frame) - 2));
|
||||||
|
|
||||||
|
#if (BY_TF_DEBUG)
|
||||||
|
printf("get: %0.2X", frame_s->crc_val);
|
||||||
|
printf("\r\n");
|
||||||
|
|
||||||
|
printf("cal: %0.2X", calc_crc_val);
|
||||||
|
printf("\r\n");
|
||||||
|
#endif
|
||||||
|
|
||||||
|
if ((frame_s->crc_val == calc_crc_val) || (frame_s->crc_val == 0xFFFF)) {
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 校验错误则直接结束监听
|
||||||
|
by_tiny_frame_parse_end_listen();
|
||||||
|
parse_done_handle(frame_now, 1);
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_parse_handle_register(by_tf_parse_done_handle_func func)
|
||||||
|
{
|
||||||
|
// FIXME 监听过程中应不允许更改
|
||||||
|
// FIXME 未校验是否传入非空值，另外假设未执行注册，也会产生非法访问
|
||||||
|
parse_done_handle = func;
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_parse_start_listen(void)
|
||||||
|
{
|
||||||
|
listen_flag = 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_parse_end_listen(void)
|
||||||
|
{
|
||||||
|
listen_flag = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_parse_set_listen_slave_id(uint8_t slave_id)
|
||||||
|
{
|
||||||
|
listen_slave_id = slave_id;
|
||||||
|
}
|
||||||
33
app/tiny_frame/by_tiny_frame_parse.h
Normal file
33
app/tiny_frame/by_tiny_frame_parse.h
Normal file
@@ -0,0 +1,33 @@
|
|||||||
|
#ifndef _BY_TINY_FRAME_PARSE_H__
|
||||||
|
#define _BY_TINY_FRAME_PARSE_H__
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
|
||||||
|
// 从机地址 (1b) - 功能码 (1b) - 寄存器地址 (2b) - 数据 (4b) - CRC(2b)
|
||||||
|
// 从机地址 (1b) 0-127, 最低位表示发送方，主机请求低位为 0，从机应答低位为 1
|
||||||
|
// 高字节在前
|
||||||
|
|
||||||
|
typedef struct by_tf_parse_frame_t {
|
||||||
|
uint8_t frame[10];
|
||||||
|
uint8_t cmd;
|
||||||
|
uint16_t reg_addr;
|
||||||
|
uint16_t crc_val;
|
||||||
|
uint32_t data;
|
||||||
|
} by_tf_parse_frame_t;
|
||||||
|
|
||||||
|
typedef void (*by_tf_parse_done_handle_func)(by_tf_parse_frame_t, uint8_t);
|
||||||
|
|
||||||
|
extern void by_tiny_frame_parse_init(void);
|
||||||
|
extern void by_tiny_frame_parse_uart_handle(uint8_t buff);
|
||||||
|
extern void by_tiny_frame_parse_timer_handle(void);
|
||||||
|
extern void by_tiny_frame_parse_run(void);
|
||||||
|
extern uint8_t by_tiny_frame_parse_crc(by_tf_parse_frame_t *frame_s);
|
||||||
|
extern void by_tiny_frame_parse_handle_register(by_tf_parse_done_handle_func func);
|
||||||
|
extern void by_tiny_frame_parse_start_listen(void);
|
||||||
|
extern void by_tiny_frame_parse_end_listen(void);
|
||||||
|
extern void by_tiny_frame_parse_set_listen_slave_id(uint8_t slave_id);
|
||||||
|
|
||||||
|
#endif
|
||||||
50
app/tiny_frame/by_tiny_frame_slave_read_write.c
Normal file
50
app/tiny_frame/by_tiny_frame_slave_read_write.c
Normal file
@@ -0,0 +1,50 @@
|
|||||||
|
#include "by_tiny_frame_slave_read_write.h"
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
#include "by_tiny_frame_pack.h"
|
||||||
|
|
||||||
|
#include "jj_param.h"
|
||||||
|
|
||||||
|
void by_tiny_frame_read_write_run(void)
|
||||||
|
{
|
||||||
|
// empty
|
||||||
|
}
|
||||||
|
|
||||||
|
void by_tiny_frame_read_write_handle(by_tf_parse_frame_t frame_s, uint8_t status)
|
||||||
|
{
|
||||||
|
by_tf_pack_frame_t frame_pack_s;
|
||||||
|
|
||||||
|
frame_pack_s.slave_id = BY_TF_DEVICE_SLAVE_ADDRESS;
|
||||||
|
frame_pack_s.cmd = frame_s.cmd;
|
||||||
|
frame_pack_s.reg_addr = frame_s.reg_addr;
|
||||||
|
|
||||||
|
if (status) {
|
||||||
|
// 接收出错，一般为 CRC 校验错误
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (frame_s.cmd) {
|
||||||
|
case 0x03:
|
||||||
|
// 添加查询接口，操作完成后应答，主机接收，即读取
|
||||||
|
frame_pack_s.data =(uint32_t)(addre[frame_pack_s.reg_addr]);
|
||||||
|
by_tiny_frame_pack_send(&frame_pack_s);
|
||||||
|
break;
|
||||||
|
case 0x06:
|
||||||
|
// 添加写入接口，操作完成后应答，主机发送，即写入
|
||||||
|
*addre[frame_pack_s.reg_addr] = frame_pack_s.data;
|
||||||
|
by_tiny_frame_pack_send(&frame_pack_s);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
#if (BY_TF_DEBUG)
|
||||||
|
printf("****** EXECUTE CMD SUCCESSFUL ******\r\n");
|
||||||
|
printf("Device ID: 0x%0.2X\r\n", BY_TF_DEVICE_SLAVE_ADDRESS);
|
||||||
|
printf("\t--cmd: %0.2X\n\t--reg_addr: 0x%0.4X\n\t--data: 0x%0.8X\r\n", frame_s.cmd, frame_s.reg_addr, frame_s.data);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
#endif
|
||||||
17
app/tiny_frame/by_tiny_frame_slave_read_write.h
Normal file
17
app/tiny_frame/by_tiny_frame_slave_read_write.h
Normal file
@@ -0,0 +1,17 @@
|
|||||||
|
#ifndef _BY_TINY_FRAME_SLAVE_READ_WRITE_H__
|
||||||
|
#define _BY_TINY_FRAME_SLAVE_READ_WRITE_H__
|
||||||
|
|
||||||
|
#include "by_tiny_frame_config.h"
|
||||||
|
|
||||||
|
#if defined(BY_TF_DEVICE_SLAVE)
|
||||||
|
|
||||||
|
#include "by_tiny_frame_parse.h"
|
||||||
|
|
||||||
|
#define BY_TINY_FRAME_READ_CMD_CODE (0x03)
|
||||||
|
#define BY_TINY_FRAME_WRITE_CMD_CODE (0x06)
|
||||||
|
|
||||||
|
extern void by_tiny_frame_read_write_run(void);
|
||||||
|
extern void by_tiny_frame_read_write_handle(by_tf_parse_frame_t frame_s, uint8_t status);
|
||||||
|
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
@@ -1 +1,185 @@
|
|||||||
ENTRY( _start )
|
ENTRY( _start )
|
||||||
|
|
||||||
|
__stack_size = 2048;
|
||||||
|
|
||||||
|
PROVIDE( _stack_size = __stack_size );
|
||||||
|
|
||||||
|
|
||||||
|
MEMORY
|
||||||
|
{
|
||||||
|
/* CH32V30x_D8C - CH32V305RB-CH32V305FB
|
||||||
|
CH32V30x_D8 - CH32V303CB-CH32V303RB
|
||||||
|
*/
|
||||||
|
/*
|
||||||
|
FLASH (rx) : ORIGIN = 0x00000000, LENGTH = 128K
|
||||||
|
RAM (xrw) : ORIGIN = 0x20000000, LENGTH = 32K
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* CH32V30x_D8C - CH32V307VC-CH32V307WC-CH32V307RC
|
||||||
|
CH32V30x_D8 - CH32V303VC-CH32V303RC
|
||||||
|
FLASH + RAM supports the following configuration
|
||||||
|
FLASH-192K + RAM-128K
|
||||||
|
FLASH-224K + RAM-96K
|
||||||
|
FLASH-256K + RAM-64K
|
||||||
|
FLASH-288K + RAM-32K
|
||||||
|
*/
|
||||||
|
RAM (xrw) : ORIGIN = 0x20000000, LENGTH = 96K
|
||||||
|
FLASH (rx) : ORIGIN = 0x00000000, LENGTH = 224K
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
SECTIONS
|
||||||
|
{
|
||||||
|
|
||||||
|
.init :
|
||||||
|
{
|
||||||
|
_sinit = .;
|
||||||
|
. = ALIGN(4);
|
||||||
|
KEEP(*(SORT_NONE(.init)))
|
||||||
|
. = ALIGN(4);
|
||||||
|
_einit = .;
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.vector :
|
||||||
|
{
|
||||||
|
*(.vector);
|
||||||
|
. = ALIGN(64);
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.text :
|
||||||
|
{
|
||||||
|
. = ALIGN(4);
|
||||||
|
*(.text)
|
||||||
|
*(.text.*)
|
||||||
|
*(.rodata)
|
||||||
|
*(.rodata*)
|
||||||
|
*(.glue_7)
|
||||||
|
*(.glue_7t)
|
||||||
|
*(.gnu.linkonce.t.*)
|
||||||
|
. = ALIGN(4);
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.fini :
|
||||||
|
{
|
||||||
|
KEEP(*(SORT_NONE(.fini)))
|
||||||
|
. = ALIGN(4);
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
PROVIDE( _etext = . );
|
||||||
|
PROVIDE( _eitcm = . );
|
||||||
|
|
||||||
|
.preinit_array :
|
||||||
|
{
|
||||||
|
PROVIDE_HIDDEN (__preinit_array_start = .);
|
||||||
|
KEEP (*(.preinit_array))
|
||||||
|
PROVIDE_HIDDEN (__preinit_array_end = .);
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.init_array :
|
||||||
|
{
|
||||||
|
PROVIDE_HIDDEN (__init_array_start = .);
|
||||||
|
KEEP (*(SORT_BY_INIT_PRIORITY(.init_array.*) SORT_BY_INIT_PRIORITY(.ctors.*)))
|
||||||
|
KEEP (*(.init_array EXCLUDE_FILE (*crtbegin.o *crtbegin?.o *crtend.o *crtend?.o ) .ctors))
|
||||||
|
PROVIDE_HIDDEN (__init_array_end = .);
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.fini_array :
|
||||||
|
{
|
||||||
|
PROVIDE_HIDDEN (__fini_array_start = .);
|
||||||
|
KEEP (*(SORT_BY_INIT_PRIORITY(.fini_array.*) SORT_BY_INIT_PRIORITY(.dtors.*)))
|
||||||
|
KEEP (*(.fini_array EXCLUDE_FILE (*crtbegin.o *crtbegin?.o *crtend.o *crtend?.o ) .dtors))
|
||||||
|
PROVIDE_HIDDEN (__fini_array_end = .);
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.ctors :
|
||||||
|
{
|
||||||
|
/* gcc uses crtbegin.o to find the start of
|
||||||
|
the constructors, so we make sure it is
|
||||||
|
first. Because this is a wildcard, it
|
||||||
|
doesn't matter if the user does not
|
||||||
|
actually link against crtbegin.o; the
|
||||||
|
linker won't look for a file to match a
|
||||||
|
wildcard. The wildcard also means that it
|
||||||
|
doesn't matter which directory crtbegin.o
|
||||||
|
is in. */
|
||||||
|
KEEP (*crtbegin.o(.ctors))
|
||||||
|
KEEP (*crtbegin?.o(.ctors))
|
||||||
|
/* We don't want to include the .ctor section from
|
||||||
|
the crtend.o file until after the sorted ctors.
|
||||||
|
The .ctor section from the crtend file contains the
|
||||||
|
end of ctors marker and it must be last */
|
||||||
|
KEEP (*(EXCLUDE_FILE (*crtend.o *crtend?.o ) .ctors))
|
||||||
|
KEEP (*(SORT(.ctors.*)))
|
||||||
|
KEEP (*(.ctors))
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.dtors :
|
||||||
|
{
|
||||||
|
KEEP (*crtbegin.o(.dtors))
|
||||||
|
KEEP (*crtbegin?.o(.dtors))
|
||||||
|
KEEP (*(EXCLUDE_FILE (*crtend.o *crtend?.o ) .dtors))
|
||||||
|
KEEP (*(SORT(.dtors.*)))
|
||||||
|
KEEP (*(.dtors))
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.dalign :
|
||||||
|
{
|
||||||
|
. = ALIGN(4);
|
||||||
|
PROVIDE(_data_vma = .);
|
||||||
|
} >RAM AT>FLASH
|
||||||
|
|
||||||
|
.dlalign :
|
||||||
|
{
|
||||||
|
. = ALIGN(4);
|
||||||
|
PROVIDE(_data_lma = .);
|
||||||
|
} >FLASH AT>FLASH
|
||||||
|
|
||||||
|
.data :
|
||||||
|
{
|
||||||
|
*(.gnu.linkonce.r.*)
|
||||||
|
*(.data .data.*)
|
||||||
|
*(.gnu.linkonce.d.*)
|
||||||
|
. = ALIGN(8);
|
||||||
|
PROVIDE( __global_pointer$ = . + 0x800 );
|
||||||
|
*(.sdata .sdata.*)
|
||||||
|
*(.sdata2.*)
|
||||||
|
*(.gnu.linkonce.s.*)
|
||||||
|
. = ALIGN(8);
|
||||||
|
*(.srodata.cst16)
|
||||||
|
*(.srodata.cst8)
|
||||||
|
*(.srodata.cst4)
|
||||||
|
*(.srodata.cst2)
|
||||||
|
*(.srodata .srodata.*)
|
||||||
|
. = ALIGN(4);
|
||||||
|
PROVIDE( _edata = .);
|
||||||
|
} >RAM AT>FLASH
|
||||||
|
|
||||||
|
.bss :
|
||||||
|
{
|
||||||
|
. = ALIGN(4);
|
||||||
|
PROVIDE( _sbss = .);
|
||||||
|
*(.sbss*)
|
||||||
|
*(.gnu.linkonce.sb.*)
|
||||||
|
*(.bss*)
|
||||||
|
*(.gnu.linkonce.b.*)
|
||||||
|
*(COMMON*)
|
||||||
|
. = ALIGN(4);
|
||||||
|
PROVIDE( _ebss = .);
|
||||||
|
} >RAM AT>FLASH
|
||||||
|
|
||||||
|
PROVIDE( _end = _ebss);
|
||||||
|
PROVIDE( end = . );
|
||||||
|
|
||||||
|
.stack ORIGIN(RAM) + LENGTH(RAM) - __stack_size :
|
||||||
|
{
|
||||||
|
PROVIDE( _heap_end = . );
|
||||||
|
. = ALIGN(4);
|
||||||
|
PROVIDE(_susrstack = . );
|
||||||
|
. = . + __stack_size;
|
||||||
|
PROVIDE( _eusrstack = .);
|
||||||
|
} >RAM
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@@ -322,8 +322,8 @@ static void ips200_set_region(uint16 x1, uint16 y1, uint16 x2, uint16 y2)
|
|||||||
// zf_assert(y2 < ips200_y_max);
|
// zf_assert(y2 < ips200_y_max);
|
||||||
|
|
||||||
ips200_write_command(0x2a);
|
ips200_write_command(0x2a);
|
||||||
ips200_write_16bit_data(x1+0);
|
ips200_write_16bit_data(x1+80);
|
||||||
ips200_write_16bit_data(x2+0);
|
ips200_write_16bit_data(x2+80);
|
||||||
|
|
||||||
ips200_write_command(0x2b);
|
ips200_write_command(0x2b);
|
||||||
ips200_write_16bit_data(y1+20);
|
ips200_write_16bit_data(y1+20);
|
||||||
|
|||||||
@@ -110,7 +110,7 @@
|
|||||||
// 例：C5-C12 IPS200_DATAPORT 设置为 GPIOC DATA_START_NUM 设置为 5
|
// 例：C5-C12 IPS200_DATAPORT 设置为 GPIOC DATA_START_NUM 设置为 5
|
||||||
// --------------------双排 SPI 接口两寸屏幕引脚定义--------------------//
|
// --------------------双排 SPI 接口两寸屏幕引脚定义--------------------//
|
||||||
|
|
||||||
#define IPS200_DEFAULT_DISPLAY_DIR (IPS200_PORTAIT) // 默认的显示方向
|
#define IPS200_DEFAULT_DISPLAY_DIR (IPS200_CROSSWISE_180) // 默认的显示方向
|
||||||
#define IPS200_DEFAULT_PENCOLOR (RGB565_YELLOW) // 默认的画笔颜色
|
#define IPS200_DEFAULT_PENCOLOR (RGB565_YELLOW) // 默认的画笔颜色
|
||||||
#define IPS200_DEFAULT_BGCOLOR (RGB565_BLACK) // 默认的背景颜色
|
#define IPS200_DEFAULT_BGCOLOR (RGB565_BLACK) // 默认的背景颜色
|
||||||
#define IPS200_DEFAULT_DISPLAY_FONT (IPS200_8X16_FONT) // 默认的字体模式
|
#define IPS200_DEFAULT_DISPLAY_FONT (IPS200_8X16_FONT) // 默认的字体模式
|
||||||
|
|||||||
@@ -54,8 +54,8 @@
|
|||||||
#if K24C02_USE_SOFT_IIC // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>ɫ<EFBFBD><C9AB><EFBFBD><EFBFBD><EFBFBD>IJ<EFBFBD><C4B2><EFBFBD><EFBFBD><EFBFBD>ȷ<EFBFBD><C8B7> <20><>ɫ<EFBFBD>ҵľ<D2B5><C4BE><EFBFBD>û<EFBFBD><C3BB><EFBFBD>õ<EFBFBD>
|
#if K24C02_USE_SOFT_IIC // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>ɫ<EFBFBD><C9AB><EFBFBD><EFBFBD><EFBFBD>IJ<EFBFBD><C4B2><EFBFBD><EFBFBD><EFBFBD>ȷ<EFBFBD><C8B7> <20><>ɫ<EFBFBD>ҵľ<D2B5><C4BE><EFBFBD>û<EFBFBD><C3BB><EFBFBD>õ<EFBFBD>
|
||||||
//====================================================<3D><><EFBFBD><EFBFBD> IIC <20><><EFBFBD><EFBFBD>====================================================
|
//====================================================<3D><><EFBFBD><EFBFBD> IIC <20><><EFBFBD><EFBFBD>====================================================
|
||||||
#define K24C02_SOFT_IIC_DELAY (500) // <20><><EFBFBD><EFBFBD> IIC <20><>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD> <20><>ֵԽС IIC ͨ<><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Խ<EFBFBD><D4BD>
|
#define K24C02_SOFT_IIC_DELAY (500) // <20><><EFBFBD><EFBFBD> IIC <20><>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD> <20><>ֵԽС IIC ͨ<><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Խ<EFBFBD><D4BD>
|
||||||
#define K24C02_SCL_PIN (E3) // <20><><EFBFBD><EFBFBD> IIC SCL <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> K24C02 <20><> SCL <20><><EFBFBD><EFBFBD>
|
#define K24C02_SCL_PIN (D13) // <20><><EFBFBD><EFBFBD> IIC SCL <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> K24C02 <20><> SCL <20><><EFBFBD><EFBFBD>
|
||||||
#define K24C02_SDA_PIN (E2 ) // <20><><EFBFBD><EFBFBD> IIC SDA <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> K24C02 <20><> SDA <20><><EFBFBD><EFBFBD>
|
#define K24C02_SDA_PIN (D12) // <20><><EFBFBD><EFBFBD> IIC SDA <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> K24C02 <20><> SDA <20><><EFBFBD><EFBFBD>
|
||||||
//====================================================<3D><><EFBFBD><EFBFBD> IIC <20><><EFBFBD><EFBFBD>====================================================
|
//====================================================<3D><><EFBFBD><EFBFBD> IIC <20><><EFBFBD><EFBFBD>====================================================
|
||||||
#else
|
#else
|
||||||
//====================================================Ӳ<><D3B2> IIC <20><><EFBFBD><EFBFBD>====================================================
|
//====================================================Ӳ<><D3B2> IIC <20><><EFBFBD><EFBFBD>====================================================
|
||||||
|
|||||||
@@ -104,8 +104,8 @@
|
|||||||
// <20><><EFBFBD><EFBFBD>ͷ<EFBFBD><CDB7>ƫ<EFBFBD><C6AB><EFBFBD><EFBFBD><EFBFBD>ݺ<EFBFBD><DDBA><EFBFBD><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD>ƣ<EFBFBD><C6A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ü<EFBFBD><C3BC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB>
|
// <20><><EFBFBD><EFBFBD>ͷ<EFBFBD><CDB7>ƫ<EFBFBD><C6AB><EFBFBD><EFBFBD><EFBFBD>ݺ<EFBFBD><DDBA><EFBFBD><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD>ƣ<EFBFBD><C6A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ü<EFBFBD><C3BC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB>
|
||||||
#define MT9V03X_UD_OFFSET_DEF (0 ) // ͼ<><CDBC><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB><EFBFBD><EFBFBD> <20><>ֵ <20><>ƫ<EFBFBD><C6AB> <20><>ֵ <20><>ƫ<EFBFBD><C6AB> <20><>Ϊ 120 240 480 ʱ<><EFBFBD><DEB7><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB>
|
#define MT9V03X_UD_OFFSET_DEF (0 ) // ͼ<><CDBC><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB><EFBFBD><EFBFBD> <20><>ֵ <20><>ƫ<EFBFBD><C6AB> <20><>ֵ <20><>ƫ<EFBFBD><C6AB> <20><>Ϊ 120 240 480 ʱ<><EFBFBD><DEB7><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB>
|
||||||
// <20><><EFBFBD><EFBFBD>ͷ<EFBFBD><CDB7>ƫ<EFBFBD><C6AB><EFBFBD><EFBFBD><EFBFBD>ݺ<EFBFBD><DDBA><EFBFBD><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD>ƣ<EFBFBD><C6A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ü<EFBFBD><C3BC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB>
|
// <20><><EFBFBD><EFBFBD>ͷ<EFBFBD><CDB7>ƫ<EFBFBD><C6AB><EFBFBD><EFBFBD><EFBFBD>ݺ<EFBFBD><DDBA><EFBFBD><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD>ƣ<EFBFBD><C6A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ü<EFBFBD><C3BC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><C6AB>
|
||||||
#define MT9V03X_GAIN_DEF (32 ) // ͼ<><CDBC><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>Χ [16-64] <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ع<EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD>̶<EFBFBD><CCB6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>¸ı<C2B8>ͼ<EFBFBD><CDBC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̶<EFBFBD>
|
#define MT9V03X_GAIN_DEF (64 ) // ͼ<><CDBC><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>Χ [16-64] <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ع<EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD>̶<EFBFBD><CCB6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>¸ı<C2B8>ͼ<EFBFBD><CDBC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̶<EFBFBD>
|
||||||
#define MT9V03X_PCLK_MODE_DEF (1 ) // <20><><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>ģʽ <20><>Χ [0-1] Ĭ<>ϣ<EFBFBD>0 <20><>ѡ<EFBFBD><D1A1><EFBFBD><EFBFBD>Ϊ<EFBFBD><CEAA>[0<><30><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ź<EFBFBD>,1<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ź<EFBFBD>]
|
#define MT9V03X_PCLK_MODE_DEF (1 ) // <20><><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>ģʽ <20><>Χ [0-1] Ĭ<>ϣ<EFBFBD>0 <20><>ѡ<EFBFBD><D1A1><EFBFBD><EFBFBD>Ϊ<EFBFBD><CEAA>[0<><30><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>źţ<EFBFBD>1<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ź<EFBFBD>]
|
||||||
// ͨ<><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ 0<><30><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʹ<EFBFBD><CAB9> CH32V307 <20><> DVP <20>ӿڻ<D3BF> STM32 <20><> DCMI <20>ӿڲɼ<DAB2><C9BC><EFBFBD>Ҫ<EFBFBD><D2AA><EFBFBD><EFBFBD>Ϊ 1
|
// ͨ<><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ 0<><30><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʹ<EFBFBD><CAB9> CH32V307 <20><> DVP <20>ӿڻ<D3BF> STM32 <20><> DCMI <20>ӿڲɼ<DAB2><C9BC><EFBFBD>Ҫ<EFBFBD><D2AA><EFBFBD><EFBFBD>Ϊ 1
|
||||||
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> MT9V034 V1.5 <20>Լ<EFBFBD><D4BC><EFBFBD><EFBFBD>ϰ汾֧<E6B1BE>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD><EFBFBD>
|
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> MT9V034 V1.5 <20>Լ<EFBFBD><D4BC><EFBFBD><EFBFBD>ϰ汾֧<E6B1BE>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD><EFBFBD>
|
||||||
|
|
||||||
|
|||||||
@@ -709,3 +709,33 @@ void soft_iic_init (soft_iic_info_struct *soft_iic_obj, uint8 addr, uint32 delay
|
|||||||
gpio_init(scl_pin, GPO, GPIO_HIGH, GPO_PUSH_PULL); // <20><>ȡ<EFBFBD><C8A1>ӦIO<49><4F><EFBFBD><EFBFBD> AF<41><46><EFBFBD>ܱ<EFBFBD><DCB1><EFBFBD>
|
gpio_init(scl_pin, GPO, GPIO_HIGH, GPO_PUSH_PULL); // <20><>ȡ<EFBFBD><C8A1>ӦIO<49><4F><EFBFBD><EFBFBD> AF<41><46><EFBFBD>ܱ<EFBFBD><DCB1><EFBFBD>
|
||||||
gpio_init(sda_pin, GPO, GPIO_HIGH, GPO_OPEN_DTAIN); // <20><>ȡ<EFBFBD><C8A1>ӦIO<49><4F><EFBFBD><EFBFBD> AF<41><46><EFBFBD>ܱ<EFBFBD><DCB1><EFBFBD>
|
gpio_init(sda_pin, GPO, GPIO_HIGH, GPO_OPEN_DTAIN); // <20><>ȡ<EFBFBD><C8A1>ӦIO<49><4F><EFBFBD><EFBFBD> AF<41><46><EFBFBD>ܱ<EFBFBD><DCB1><EFBFBD>
|
||||||
}
|
}
|
||||||
|
void eep_soft_iic_read_8bit_registers (soft_iic_info_struct *soft_iic_obj, const uint8 register_name_h, const uint8 register_name_l, uint8 *data, uint32 len)
|
||||||
|
{
|
||||||
|
zf_assert(soft_iic_obj != NULL);
|
||||||
|
zf_assert(data != NULL);
|
||||||
|
soft_iic_start(soft_iic_obj);
|
||||||
|
soft_iic_send_data(soft_iic_obj, soft_iic_obj->addr << 1);
|
||||||
|
soft_iic_send_data(soft_iic_obj, register_name_h);
|
||||||
|
soft_iic_send_data(soft_iic_obj, register_name_l);
|
||||||
|
soft_iic_start(soft_iic_obj);
|
||||||
|
soft_iic_send_data(soft_iic_obj, soft_iic_obj->addr << 1 | 0x01);
|
||||||
|
while(len --)
|
||||||
|
{
|
||||||
|
*data ++ = soft_iic_read_data(soft_iic_obj, len == 0);
|
||||||
|
}
|
||||||
|
soft_iic_stop(soft_iic_obj);
|
||||||
|
}
|
||||||
|
void eep_soft_iic_write_8bit_registers (soft_iic_info_struct *soft_iic_obj, const uint8 register_name_h,const uint8 register_name_l, const uint8 *data, uint32 len)
|
||||||
|
{
|
||||||
|
zf_assert(soft_iic_obj != NULL);
|
||||||
|
zf_assert(data != NULL);
|
||||||
|
soft_iic_start(soft_iic_obj);
|
||||||
|
soft_iic_send_data(soft_iic_obj, soft_iic_obj->addr << 1);
|
||||||
|
soft_iic_send_data(soft_iic_obj, register_name_h);
|
||||||
|
soft_iic_send_data(soft_iic_obj, register_name_l);
|
||||||
|
while(len --)
|
||||||
|
{
|
||||||
|
soft_iic_send_data(soft_iic_obj, *data ++);
|
||||||
|
}
|
||||||
|
soft_iic_stop(soft_iic_obj);
|
||||||
|
}
|
||||||
@@ -36,7 +36,6 @@
|
|||||||
#ifndef _zf_driver_soft_iic_h_
|
#ifndef _zf_driver_soft_iic_h_
|
||||||
#define _zf_driver_soft_iic_h_
|
#define _zf_driver_soft_iic_h_
|
||||||
|
|
||||||
|
|
||||||
#include "zf_driver_gpio.h"
|
#include "zf_driver_gpio.h"
|
||||||
|
|
||||||
typedef struct
|
typedef struct
|
||||||
@@ -79,5 +78,6 @@ uint8 soft_iic_sccb_read_register (soft_iic_info_struct *soft_iic_obj,
|
|||||||
|
|
||||||
void soft_iic_init(soft_iic_info_struct *soft_iic_obj, uint8 addr, uint32 delay, gpio_pin_enum scl_pin, gpio_pin_enum sda_pin);
|
void soft_iic_init(soft_iic_info_struct *soft_iic_obj, uint8 addr, uint32 delay, gpio_pin_enum scl_pin, gpio_pin_enum sda_pin);
|
||||||
|
|
||||||
|
void eep_soft_iic_write_8bit_registers(soft_iic_info_struct *soft_iic_obj, const uint8 register_name_h, const uint8 register_name_l, const uint8 *data, uint32 len);
|
||||||
|
void eep_soft_iic_read_8bit_registers(soft_iic_info_struct *soft_iic_obj, const uint8 register_name_h, const uint8 register_name_l, uint8 *data, uint32 len);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user