feat: 增加任务中巡线指定距离指令

This commit is contained in:
bmy
2024-06-14 15:11:17 +08:00
parent 2a3993ea62
commit 24a816d6f8
4 changed files with 171 additions and 66 deletions

View File

@@ -1,21 +1,9 @@
from simple_pid import PID
import zmq
import time
from loguru import logger
import utils
class PidWrap:
def __init__(self, kp, ki, kd, setpoint=0, output_limits=1):
self.pid_t = PID(kp, ki, kd, setpoint, output_limits=(0-output_limits, output_limits))
def set_target(self, target):
self.pid_t.setpoint = target
def set(self, kp, ki, kd):
self.pid_t.Kp = kp
self.pid_t.Ki = ki
self.pid_t.Kd = kd
def get(self, val_in):
return self.pid_t(val_in)
from utils import PidWrap
class main_task():
def __init__(self,by_cmd):