波浪补偿控制(AHC)之波浪发生器(CODESYS完整源代码)

波浪发生器的作用和详细结构以及算法介绍请参看专栏的系列文章，这里不再赘述，受水平和能力所限，文中难免出现错误和不足，诚恳的欢迎大家批评和指正。

1、波浪发生器(FB) 

CODESYS平台如何建立FC和FB，请参看CODESYS专栏。

2、接口和代码部分

 3、完整ST代码

FUNCTION_BLOCK SimuWave
VAR_INPUT
	bRun :BOOL;
    iMode :INT;//模式选择
END_VAR
VAR_OUTPUT
	heavePos :REAL;//起伏高度 单位m;
    heaveVel :REAL;//起伏速度单位m/s;
    heaveAcc :REAL;//起伏加速度 单位m/s^2;
END_VAR
VAR
	count : INT;
    n : INT;
    EN_Stutic : BOOL;
    mode_Stutic : BYTE;
    lastVel { S7_SetPoint := 'T