github/PythonRobotics
1
1
Fork 0
mirror of https://github.com/AtsushiSakai/PythonRobotics.git synced 2026-02-16 14:05:30 -05:00
Code Issues Packages Projects Releases Wiki Activity

add header comment in each scripts

Browse Source
This commit is contained in:
Takayuki Murooka
2019-01-26 15:28:59 +09:00
parent 33e7b67db0
commit 47b497019a
3 changed files with 15 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
ArmNavigation/n_joint_arm_3d/NLinkArm.py
View File

@@ -1,3 +1,7 @@
"""
Class of n-link arm in 3D
Author: Takayuki Murooka (takayuki5168)
"""
import numpy as np
import math
from mpl_toolkits.mplot3d import Axes3D

7
ArmNavigation/n_joint_arm_3d/random_forward_kinematics.py
View File

@@ -1,3 +1,7 @@
"""
Forward Kinematics for an n-link arm in 3D
Author: Takayuki Murooka (takayuki5168)
"""
import math
from NLinkArm import NLinkArm
import random
@@ -17,7 +21,8 @@ if __name__ == "__main__":
[0., -math.pi/2, 0., .321],
[0., math.pi/2, 0., 0.],
[0., 0., 0., 0.]])
# execute FK 10 times
for i in range(10):
n_link_arm.set_joint_angles([random_val(-1, 1) for j in range(len(n_link_arm.link_list))])

5
ArmNavigation/n_joint_arm_3d/random_inverse_kinematics.py
View File

@@ -1,3 +1,7 @@
"""
Inverse Kinematics for an n-link arm in 3D
Author: Takayuki Murooka (takayuki5168)
"""
import math
from NLinkArm import NLinkArm
import random
@@ -18,6 +22,7 @@ if __name__ == "__main__":
[0., math.pi/2, 0., 0.],
[0., 0., 0., 0.]])
# execute IK 10 times
for i in range(10):
n_link_arm.inverse_kinematics([random_val(-0.5, 0.5),
random_val(-0.5, 0.5),