我想使用 P 控制器(以及稍后的 PID)来控制电机。这是我用于 P 控制器的 VHDL 代码:
library IEEE;
use IEEE.STD_LOGIC_1164.ALL;
USE ieee.numeric_std.ALL;
USE ieee.STD_LOGIC_ARITH.ALL;
USE ieee.std_logic_signed.ALL;
entity P is
Port ( e : in STD_LOGIC_VECTOR (8 downto 0);
PWM : out STD_LOGIC_VECTOR (8 downto 0));
end P;
architecture Behavioral of P is
signal eInt : integer := 0;
signal PWMInt : integer := 0;
--min/max
signal borne : integer := 255;
--Gain
signal Ku : integer := 1;
--saturation
component saturation is
Port ( entier : in integer;
borne : in integer;
sotie : out STD_LOGIC_VECTOR (8 downto 0));
end component;
begin
eInt <= conv_integer(e);
PWMInt <= Ku*eInt;
sat : saturation port map(PWMInt, borne, PWM);
end Behavioral;
其中饱和将 PWM 的数量限制为“承受”(因此 PWM 最多为二进制 255),e 是误差(命令 - 测量)。
该模块的输出是直接进入电机的 PWM(这在另一个文件中完成)。开环工作得很好,闭环很糟糕。我强烈怀疑我处理整数的方式有问题,因为测试台工作正常,但物理实现根本不正确。