Skip to content

Commit 213a19d

Browse files
committed
Simplify extrapolate code
1 parent 142e591 commit 213a19d

File tree

1 file changed

+1
-4
lines changed

1 file changed

+1
-4
lines changed

resources/external_control.urscript

Lines changed: 1 addition & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -149,10 +149,7 @@ end
149149

150150
def extrapolate():
151151
cmd_servo_q_last = cmd_servo_q
152-
local vel = get_target_joint_speeds()
153-
local diff = [vel[0] * steptime, vel[1] * steptime, vel[2] * steptime, vel[3] * steptime, vel[4] * steptime, vel[5] * steptime]
154-
cmd_servo_q = [cmd_servo_q[0] + diff[0], cmd_servo_q[1] + diff[1], cmd_servo_q[2] + diff[2], cmd_servo_q[3] + diff[3], cmd_servo_q[4] + diff[4], cmd_servo_q[5] + diff[5]]
155-
152+
cmd_servo_q = cmd_servo_q + (get_target_joint_speeds() * steptime)
156153
return cmd_servo_q
157154
end
158155

0 commit comments

Comments
 (0)