Skip to main content

Pepper Inverse/Forward Kinematics library

Project description

pepper_kinematics
=====================

Description
---------------------

Originally, Pepper does not provide any inverse kinematics function. This provides simple inverse kinematics funciton.

Example
---------------------
"""
Move work_pose first, then move 5 centimeters toward left (y axis positive side).
"""

import time
import numpy as np
import naoqi as n
import pepper_kinematics as pk

host = 'nao.local'
port = 9559

m = n.ALProxy("ALMotion", host, port)
m.setAngles(pk.left_arm_tags, pk.left_arm_work_pose, 1.0)

time.sleep(1.0)

current_angles = m.getAngles(pk.left_arm_tags)
current_position, current_orientation = pk.left_arm_get_position(current_angles)

target_position = current_position
target_position[1] = target_position[1] + 0.05 # 5 cm toward left
target_orientation = current_orientation # This is not supported yet

target_angles = p.left_arm_set_position(current_angles, target_position, target_orientation)
if target_angles:
m.setAngles(pk.left_arm_tags, target_angles, 1.0)


How to install
---------------------
sudo pip install pepper_kinematics

Copyright
---------------------
* author: Yuki Suga
* copyright: Yuki Suga @ ssr.tokyo
* license: GPLv3

Project details


Download files

Download the file for your platform. If you're not sure which to choose, learn more about installing packages.

Filename, size & hash SHA256 hash help File type Python version Upload date
pepper_kinematics-0.0.6.tar.gz (3.6 kB) Copy SHA256 hash SHA256 Source None

Supported by

Elastic Elastic Search Pingdom Pingdom Monitoring Google Google BigQuery Sentry Sentry Error logging AWS AWS Cloud computing DataDog DataDog Monitoring Fastly Fastly CDN SignalFx SignalFx Supporter DigiCert DigiCert EV certificate StatusPage StatusPage Status page