Advertisement
Guest User

Untitled

a guest
Nov 22nd, 2017
71
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.28 KB | None | 0 0
  1. sequence0 = [(2.5, 2, 3, 0, 2),
  2. (2.5, 2.3, 1.0, 0, 3),
  3. (2.0, 2.3, 1.0, 0, 4),
  4. (2.0, 2.5, 1.0, 0, 5),
  5. (2.0, 2.5, 0.5, 0, 6)]
  6.  
  7. sequence1 = [(2.0, 2.5, 1.0, 0),
  8. (2.0, 2.7, 1.0, 0),
  9. (2.5, 2.7, 1.0, 0),
  10. (2.5, 2.5, 1.0, 0),
  11. (2.5, 2.5, 0.5, 0)]
  12.  
  13. seq_args = {
  14. URI0: [sequence0],
  15. URI1: [sequence1],
  16. }
  17.  
  18. #in meters
  19. actual_per_grid_x_res = 0.5
  20. actual_per_grid_y_res = 0.5
  21. actual_per_grid_z_res = 0.5
  22. actual_area_x_max_size = 3
  23. actual_area_y_max_size = 3
  24. actual_area_z_max_size = 3
  25.  
  26. def g_actual_trajectory(f, seq):
  27. for s in seq:
  28. for k in range(s[4]):
  29. 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]))
  30.  
  31. def g_circle_trajectory(f, o_x, o_y, radius)
  32.  
  33.  
  34. #def g_actual_trajectory(seq):
  35. # for s in seq:
  36. # for k in range(s[4]):
  37. # 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]))
  38.  
  39. def r_actual_trajectory(f2):
  40. f2.seek(0)
  41. for s in f2:
  42. s.strip()
  43. ss = s.split(',')
  44. for i in ss:
  45. print(float(i))
  46.  
  47.  
  48. f = tempfile.TemporaryFile()
  49. g_actual_trajectory(f, sequence0)
  50. r_actual_trajectory(f)
  51. f.close()
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement