dz = (11.973-0.5-0.375+0.3125)*25.4 p0 = [-45.0,-8.5,104.0,0.0,0.0,0.0] l5_basis = ogp_util.make_pin_basis(np.array([0.0, 0.0, 0.0]), np.array([-1.0, 0.0, 0.0]), np.array([0.0, 0.0, 1.0])) modulesurvey_basis = ogp_util.make_basis(np.array([0.0, 0.0, 0.0]), np.array([-1.0, 0.0, 0.0]), np.array([0.0, 0.0, 1.0])) is_top = -1 else: print 'Invalid side' sys.exit() [l4se, l4sp] = ogp_util.get_l456_sensors(sys.argv[5],'front') l4se = ogp_util.make_sensor_basis(l4se) l4sp = ogp_util.make_sensor_basis(l4sp) [l4ae, l4ap] = ogp_util.get_l456_sensors(sys.argv[6],'back') l4ae = ogp_util.make_sensor_basis(l4ae) l4ap = ogp_util.make_sensor_basis(l4ap) [l5se, l5sp] = ogp_util.get_l456_sensors(sys.argv[7],'front') l5se = ogp_util.make_sensor_basis(l5se) l5sp = ogp_util.make_sensor_basis(l5sp) [l5ae, l5ap] = ogp_util.get_l456_sensors(sys.argv[8],'back') l5ae = ogp_util.make_sensor_basis(l5ae) l5ap = ogp_util.make_sensor_basis(l5ap) [l6se, l6sp] = ogp_util.get_l456_sensors(sys.argv[9],'front') l6se = ogp_util.make_sensor_basis(l6se) l6sp = ogp_util.make_sensor_basis(l6sp) [l6ae, l6ap] = ogp_util.get_l456_sensors(sys.argv[10],'back') l6ae = ogp_util.make_sensor_basis(l6ae)
is_top = 1 elif (side=='bottom'): dz = (11.973-0.5-0.375+0.3125)*25.4 p0 = [-45.0,-8.5,104.0,0.0,0.0,0.0] l2_basis = ogp_util.make_pin_basis(np.array([0.0, 0.0, 0.0]), np.array([-1.0, 0.0, 0.0]), np.array([0.0, 0.0, 1.0])) modulesurvey_basis = ogp_util.make_basis(np.array([0.0, 0.0, 0.0]), np.array([-1.0, 0.0, 0.0]), np.array([0.0, 0.0, 1.0])) is_top = -1 else: print 'Invalid side' sys.exit() l1s = ogp_util.make_sensor_basis(ogp_util.get_l123_sensor(sys.argv[5],'front')) #pin basis in sensor frame #print l1s l1a = ogp_util.make_sensor_basis(ogp_util.get_l123_sensor(sys.argv[6],'back')) #print l1a l2s = ogp_util.make_sensor_basis(ogp_util.get_l123_sensor(sys.argv[7],'front')) l2a = ogp_util.make_sensor_basis(ogp_util.get_l123_sensor(sys.argv[8],'back')) l3s = ogp_util.make_sensor_basis(ogp_util.get_l123_sensor(sys.argv[9],'front')) l3a = ogp_util.make_sensor_basis(ogp_util.get_l123_sensor(sys.argv[10],'back')) noballsdict = ogp_util.getsteps(sys.argv[2]) ballsdict = ogp_util.getsteps(sys.argv[3]) modulesdict = ogp_util.getsteps(sys.argv[4])
elif (side == 'bottom'): dz = (11.973 - 0.5 - 0.375 + 0.3125) * 25.4 p0 = [-45.0, -8.5, 104.0, 0.0, 0.0, 0.0] l5_basis = ogp_util.make_pin_basis(np.array([0.0, 0.0, 0.0]), np.array([-1.0, 0.0, 0.0]), np.array([0.0, 0.0, 1.0])) modulesurvey_basis = ogp_util.make_basis(np.array([0.0, 0.0, 0.0]), np.array([-1.0, 0.0, 0.0]), np.array([0.0, 0.0, 1.0])) is_top = -1 else: print 'Invalid side' sys.exit() [l4se, l4sp] = ogp_util.get_l456_sensors(sys.argv[5], 'front') l4se = ogp_util.make_sensor_basis(l4se) l4sp = ogp_util.make_sensor_basis(l4sp) [l4ae, l4ap] = ogp_util.get_l456_sensors(sys.argv[6], 'back') l4ae = ogp_util.make_sensor_basis(l4ae) l4ap = ogp_util.make_sensor_basis(l4ap) [l5se, l5sp] = ogp_util.get_l456_sensors(sys.argv[7], 'front') l5se = ogp_util.make_sensor_basis(l5se) l5sp = ogp_util.make_sensor_basis(l5sp) [l5ae, l5ap] = ogp_util.get_l456_sensors(sys.argv[8], 'back') l5ae = ogp_util.make_sensor_basis(l5ae) l5ap = ogp_util.make_sensor_basis(l5ap) [l6se, l6sp] = ogp_util.get_l456_sensors(sys.argv[9], 'front') l6se = ogp_util.make_sensor_basis(l6se) l6sp = ogp_util.make_sensor_basis(l6sp) [l6ae, l6ap] = ogp_util.get_l456_sensors(sys.argv[10], 'back') l6ae = ogp_util.make_sensor_basis(l6ae)