plecs实现数字滤波

最新推荐文章于 2024-11-18 10:31:05 发布

东门吹嘘

最新推荐文章于 2024-11-18 10:31:05 发布

阅读量456

点赞数

文章标签： c语言

本文链接：https://blog.csdn.net/qq_33167250/article/details/134173173

版权

plecs实现数字滤波

1、PLECS仿真

![(https://img-blog.csdnimg.cn/8d100de3fccf4d5595532391d149c55d.png)](https://img-blog.csdnimg.cn/762d565f13944ef5bfa077b501ea9376.png

2、declaration

#include <stdio.h>

// 输入定义
#define     VOLT_SAMPLE       Input(0)

// 输出定义

// 离散状态变量定义

// 时间定义
#define     SYS_TIME1S_BS12US5      (80000)
#define     TIME1MS_BS12US5         (80000 / 1000)
#define     SYS_TIMER_PRD           SYS_TIME1S_BS12US5

// 非离散全局变量定义
int g_sysTimerCnt;
int g_isrTaskIndex;
// 输入输出量定义
double g_voltSample;
double g_voltFilt1;
double g_voltFilt2;
int g_isrCnt;

// 函数定义
inline void SysTimerRun(void)
{
    if (++g_sysTimerCnt >= SYS_TIMER_PRD) {
        g_sysTimerCnt = 0;
    }
}

// 分频中断任务
typedef void (*Fun)(void);

void IsrTask1(void)
{
    g_isrCnt++;
}

void IsrTask2(void) {}
void IsrTask3(void) {}
void IsrTask4(void) {}
void IsrTask5(void) {}
void IsrTask6(void) {}
void IsrTask7(void) {}
void IsrTask8(void) {}

const Fun g_isrFun[8] = {
    IsrTask1,
    IsrTask2,
    IsrTask3,
    IsrTask4,
    IsrTask5,
    IsrTask6,
    IsrTask7,
    IsrTask8,
};

void Sample(void)
{
	g_voltFilt1 += (g_voltSample - g_voltFilt1) / 1024;
}

inline void IsrTaskRun(void)
{

	 Sample();
    g_isrFun[g_isrTaskIndex]();
    if (++g_isrTaskIndex >= 8) {
        g_isrTaskIndex = 0;
    }
}

// 后台慢速任务
void TaskRun(void)
{
    static int sysTimerCntFor1msPre = 0;

    int delta = g_sysTimerCnt - sysTimerCntFor1msPre;
    delta = delta < 0 ? delta + SYS_TIMER_PRD : delta;

    if (delta >= TIME1MS_BS12US5) {
        g_voltFilt2 += (g_voltSample - g_voltFilt2) / 64;
        sysTimerCntFor1msPre = g_sysTimerCnt;
    }
}

3、start_function

// 初始化变量
g_sysTimerCnt = 0;
g_isrTaskIndex = 0;
g_isrCnt = 0;

4、output_function

// 输出
Output(0) = g_voltFilt1;
Output(1) = g_voltFilt2;

5、update_funcion

// 输入量
g_voltSample = VOLT_SAMPLE;
// 离散
g_voltFilt1 = DiscState(0);
g_voltFilt2 = DiscState(1);

SysTimerRun();
IsrTaskRun();
TaskRun();

DiscState(0) = g_voltFilt1;
DiscState(1) = g_voltFilt2;