Note
Go to the end to download the full example code
LQT#
This example shows how to use the LQT controller to track a trajectory.
[Rofunc:MODULE] Planning smooth trajectory via LQT
import os
import numpy as np
import rofunc as rf
via_points = np.load('../data/LQT_LQR/rolling_pin_1.npy')
filter_indices = [0, 1, 5, 10, 22, 36]
via_points = via_points[filter_indices]
cfg = rf.config.utils.get_config("./planning", "lqt")
controller = rf.planning_control.lqt.LQT(via_points, cfg)
u_hat, x_hat, mu, idx_slices = controller.solve()
rf.lqt.plot_3d_uni(x_hat, mu, idx_slices, ori=False, save=False)
Total running time of the script: (0 minutes 4.229 seconds)