7.如何使用当前可用功率上限(一)
以底盘的速度环为例,我们对实际轮子速度和目标速度进行PID计算以后得出一个电机的目标电流值,将这个目标电流值发给电调驱动电机。 3508和C620电调的电流环性能非常好,我们在这里可以认为其实际电流值完美跟随其目标电流值(前面设定缓冲能量危险值而不是把缓冲能量用光就是防止这个近似处理导致的超功率)。 因此认为发给电调的目标电流值乘以24V(底盘供电电压)近似等于该电机的功率。 对于电机的功率约束有两种方法。一个是限制目标速度,一个是限制最后的输出电流。 限制目标速度是通过控制给速度环PID的目标值来减小目标电流从而控制底盘功率。其能保证底盘四个轮子协调运动,不影响其运动方向。但是目标速度和目标电流之间不是线性关系,你很难直接找到一个好的速度值。这里提供一个思路:计算PID,获得四个电机的电流目标值,其和若大于当前可用功率限制,则同比例增大/缩小(取决于加速还是减速)速度。再次计算,直至总功率小于限制值或达到设定循环次数上限(此时就可以直接削弱目标电流来保证) |