Skip to content

Instantly share code, notes, and snippets.

@Cj1m
Created November 20, 2019 09:30
Show Gist options
  • Save Cj1m/5f38b87f9b0d39aedfe994fb883f0148 to your computer and use it in GitHub Desktop.
Save Cj1m/5f38b87f9b0d39aedfe994fb883f0148 to your computer and use it in GitHub Desktop.
a23 = np.matrix([math.cos(link2_angle[0]), 0, math.sin(link2_angle[0]), 0],
[0, 1, 0, 0],
[-math.sin(link2_angle[0]), 0, math.cos(link2_angle[0]), 0],
[0,0,0,1])
a34 = np.matrix([1,0,0,0],
[0, math.cos(link3_angle[1]), -math.sin(link3_angle[1]), 0],
[0, math.sin(link3_angle[1]), math.cos(link3_angle[1]), 3],
[0,0,0,1])
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment