Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- sequence0 = [(2.5, 2, 3, 0, 2),
- (2.5, 2.3, 1.0, 0, 3),
- (2.0, 2.3, 1.0, 0, 4),
- (2.0, 2.5, 1.0, 0, 5),
- (2.0, 2.5, 0.5, 0, 6)]
- sequence1 = [(2.0, 2.5, 1.0, 0),
- (2.0, 2.7, 1.0, 0),
- (2.5, 2.7, 1.0, 0),
- (2.5, 2.5, 1.0, 0),
- (2.5, 2.5, 0.5, 0)]
- seq_args = {
- URI0: [sequence0],
- URI1: [sequence1],
- }
- #in meters
- actual_per_grid_x_res = 0.5
- actual_per_grid_y_res = 0.5
- actual_per_grid_z_res = 0.5
- actual_area_x_max_size = 3
- actual_area_y_max_size = 3
- actual_area_z_max_size = 3
- def g_actual_trajectory(f, seq):
- for s in seq:
- for k in range(s[4]):
- f.write("{},{},{},{}\n".format( s[0] * actual_per_grid_x_res, s[1] *actual_per_grid_y_res, s[2] * actual_per_grid_z_res, s[3]))
- def g_circle_trajectory(f, o_x, o_y, radius)
- #def g_actual_trajectory(seq):
- # for s in seq:
- # for k in range(s[4]):
- # f.write("{},{},{},{}\n".format( s[0] * actual_per_grid_x_res, s[1] *actual_per_grid_y_res, s[2] * actual_per_grid_z_res, s[3]))
- def r_actual_trajectory(f2):
- f2.seek(0)
- for s in f2:
- s.strip()
- ss = s.split(',')
- for i in ss:
- print(float(i))
- f = tempfile.TemporaryFile()
- g_actual_trajectory(f, sequence0)
- r_actual_trajectory(f)
- f.close()
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement