Dual Quaternion based MPC generating skrew motion for n-DOF robot arm.
Project description
skrewmpcpy
Generate smooth motions for a n-DOF robot arm end effector using Dual Quaternions while enforcing velocity-, acceleration- and jerk constraints. The package includes a base optimization scheme and a base motion generator, which can be easily extended for custom robot arms. A motion generator for the Franka Emika Panda robot is included.
Install
Getting started
Extending the available robots
For adding your custom robot arm, you easily can extend the base class. Make sure the forward kinematics of your robot are available.
Create a new file your_robot_mg.py
in folder src/skrewmpc.py
.
Costum robot example
from dqrobotics import DQ
from .basemg import BaseMotionGenerator
from .skrewmpc import BOUND
class YourRobotMotionGenerator(BaseMotionGenerator):
def __init__(
self,
n_p: int,
n_c: int,
q_mpc: float,
r_mpc: float,
lu_bound_vel: BOUND,
lu_bound_acc: BOUND,
lu_bound_jerk: BOUND,
) -> None:
super().__init__(
n_p, n_c, q_mpc, r_mpc, lu_bound_vel, lu_bound_acc, lu_bound_jerk
)
# custom attributes here
self._kin = YourRobotKinematics()
def step(self, q_robot: np.ndarray, goal: DQ) -> np.ndarray:
# Initialize Dual Quaternion with 6D pose
x_current = DQ(self._kin.your_forward_kinematics(q_robot))
error, smooth_traj = super()._step(x_current, goal)
# calculate commanded dq here
...
return dq
Project details
Release history Release notifications | RSS feed
Download files
Download the file for your platform. If you're not sure which to choose, learn more about installing packages.
Source Distribution
skrewmpcpy-0.1.1.tar.gz
(37.0 kB
view hashes)
Built Distribution
skrewmpcpy-0.1.1-py3-none-any.whl
(10.6 kB
view hashes)
Close
Hashes for skrewmpcpy-0.1.1-py3-none-any.whl
Algorithm | Hash digest | |
---|---|---|
SHA256 | 2f102ad793056c395fcad066e8cc9993f5d70b2c9fd0c741292ef270bfd879f1 |
|
MD5 | 56016361f7aa34587aa4433c31397970 |
|
BLAKE2b-256 | d512af40d71d4600134dae86dad0a25ca996d69740a8292976aeff506c725cd1 |