MCPcopy Create free account
hub / github.com/OpenDriveLab/TCP / step

Method step

TCP/model.py:18–30  ·  view source on GitHub ↗
(self, error)

Source from the content-addressed store, hash-verified

16 self._min = 0.0
17
18 def step(self, error):
19 self._window.append(error)
20 self._max = max(self._max, abs(error))
21 self._min = -abs(self._max)
22
23 if len(self._window) >= 2:
24 integral = np.mean(self._window)
25 derivative = (self._window[-1] - self._window[-2])
26 else:
27 integral = 0.0
28 derivative = 0.0
29
30 return self._K_P * error + self._K_I * integral + self._K_D * derivative
31
32class TCP(nn.Module):
33

Callers 1

control_pidMethod · 0.45

Calls

no outgoing calls

Tested by

no test coverage detected