@shawn_ricardo , just to close the loop on the original issue.. the delay in the calibration procedure was caused by UART data or processing of the ESC feedback backing up. The fix is to just slow down the command rate, seen in this commit : https://gitlab.com/voxl-public/voxl-sdk/utilities/voxl-esc/-/commit/b512f9e3d5e695868775de3d40eedb2ad15cf6d9 . Additionally, using command line argument --cmd-rate 100
when you run the calibration script on VOXL2 will fix the issue.
Regarding the issue in the step response where the feedback data appears not smooth, i believe it is related to FTID's buffer / delay. FTDI adapters have this parameter latency_timer
which is 16ms by default, which amount of time the FTDI board holds the RX'ed data before passing forwarding it to the PC (and vice versa, i believe). You can set that value to 1:
You can check this value:
cat /sys/bus/usb-serial/devices/ttyUSB0/latency_timer
And set it:
sudo su
echo 1 > /sys/bus/usb-serial/devices/ttyUSB0/latency_timer
You would need to do this every time you unplug / plug the FTDI device back in.
(note that this applies only to Linux PC, not VOXL2).
Besides this, i think the plots look good. It looks like you have set the kp pretty low, which keeps the response softer (less chance of de-sync).
Alex