Skip to main content

Dual Quaternion based MPC generating skrew motion for n-DOF robot arm.

Project description

skrewmpcpy

Actions Status Documentation Status PyPI version PyPI platforms GitHub Discussion

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


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 details)

Uploaded Source

Built Distribution

skrewmpcpy-0.1.1-py3-none-any.whl (10.6 kB view details)

Uploaded Python 3

File details

Details for the file skrewmpcpy-0.1.1.tar.gz.

File metadata

  • Download URL: skrewmpcpy-0.1.1.tar.gz
  • Upload date:
  • Size: 37.0 kB
  • Tags: Source
  • Uploaded using Trusted Publishing? No
  • Uploaded via: twine/5.0.0 CPython/3.9.18

File hashes

Hashes for skrewmpcpy-0.1.1.tar.gz
Algorithm Hash digest
SHA256 dba4796a527e8f08d707f7a1973bbafd224d51f321b779f80db8b514221fa6ff
MD5 083def3277f2960caf7cbc40ba258c90
BLAKE2b-256 30f87c47f2298c1cd30754d19f350044ba46caf5f22f877fd115c4802acf69ec

See more details on using hashes here.

File details

Details for the file skrewmpcpy-0.1.1-py3-none-any.whl.

File metadata

  • Download URL: skrewmpcpy-0.1.1-py3-none-any.whl
  • Upload date:
  • Size: 10.6 kB
  • Tags: Python 3
  • Uploaded using Trusted Publishing? No
  • Uploaded via: twine/5.0.0 CPython/3.9.18

File hashes

Hashes for skrewmpcpy-0.1.1-py3-none-any.whl
Algorithm Hash digest
SHA256 2f102ad793056c395fcad066e8cc9993f5d70b2c9fd0c741292ef270bfd879f1
MD5 56016361f7aa34587aa4433c31397970
BLAKE2b-256 d512af40d71d4600134dae86dad0a25ca996d69740a8292976aeff506c725cd1

See more details on using hashes here.

Supported by

AWS AWS Cloud computing and Security Sponsor Datadog Datadog Monitoring Fastly Fastly CDN Google Google Download Analytics Microsoft Microsoft PSF Sponsor Pingdom Pingdom Monitoring Sentry Sentry Error logging StatusPage StatusPage Status page