Go to the documentation of this file.00001 import numpy as np
00002 import math
00003
00004 from three_link_planar_common import *
00005
00006
00007 b_jt_limits_max = np.radians([150, 162, 159]).tolist()
00008 b_jt_limits_min = np.radians([-150, -162, -159]).tolist()
00009
00010 b_jts = {'anchor':b_jt_anchor, 'axis':b_jt_axis, 'jt_lim_max':b_jt_limits_max,
00011 'jt_lim_min':b_jt_limits_min, 'jt_init':b_jt_start, 'jt_attach':b_jt_attach,
00012 'jt_stiffness':b_jt_kp, 'jt_damping':b_jt_kd}
00013
00014 bod_shapes = ['capsule', 'capsule', 'capsule']
00015
00016 dia = 0.03
00017 bod_dimensions = [[dia, dia, torso_half_width], [dia, dia, upper_arm_length],
00018 [dia, dia, forearm_length-dia/2]]
00019
00020 bod_com_position = [[0., -torso_half_width/2., height],
00021 [0., -torso_half_width-upper_arm_length/2., height],
00022 [0., -torso_half_width-upper_arm_length-forearm_length/2.+dia/4, height]]
00023
00024 bodies ={'shapes':bod_shapes, 'dim':bod_dimensions, 'num_links':bod_num_links,
00025 'com_pos':bod_com_position, 'mass':bod_mass, 'name':bod_names, 'color':bod_color}
00026