def __init__(self, hyperparams): self._hyperparams = hyperparams self._log_filename = self._hyperparams['log_filename'] if 'target_filename' in self._hyperparams: self._target_filename = self._hyperparams['target_filename'] else: self._target_filename = None # GPS Training Status. self.mode = config[ 'initial_mode'] # Modes: run, wait, end, request, process. self.request = None # Requests: stop, reset, go, fail, None. self.err_msg = None self._colors = { 'run': 'cyan', 'wait': 'orange', 'end': 'red', 'stop': 'red', 'reset': 'yellow', 'go': 'green', 'fail': 'magenta', } self._first_update = True # Actions. actions_arr = [ Action('stop', 'stop', self.request_stop, axis_pos=0), Action('reset', 'reset', self.request_reset, axis_pos=1), Action('go', 'go', self.request_go, axis_pos=2), Action('fail', 'fail', self.request_fail, axis_pos=3), ] # Setup figure. plt.ion() plt.rcParams['toolbar'] = 'None' for key in plt.rcParams: if key.startswith('keymap.'): plt.rcParams[key] = '' self._fig = plt.figure(figsize=config['figsize']) self._fig.subplots_adjust(left=0.01, bottom=0.01, right=0.99, top=0.99, wspace=0, hspace=0) # Assign GUI component locations. self._gs = gridspec.GridSpec(16, 8) self._gs_action_panel = self._gs[0:1, 0:8] self._gs_action_output = self._gs[1:2, 0:4] self._gs_status_output = self._gs[2:3, 0:4] self._gs_cost_plotter = self._gs[1:3, 4:8] self._gs_gt_cost_plotter = self._gs[4:6, 4:8] self._gs_algthm_output = self._gs[3:9, 0:4] if config['image_on']: self._gs_traj_visualizer = self._gs[9:16, 0:4] self._gs_image_visualizer = self._gs[9:16, 4:8] else: self._gs_traj_visualizer = self._gs[9:16, 0:8] # Create GUI components. self._action_panel = ActionPanel(self._fig, self._gs_action_panel, 1, 4, actions_arr) self._action_output = Textbox(self._fig, self._gs_action_output, border_on=True) self._status_output = Textbox(self._fig, self._gs_status_output, border_on=False) self._algthm_output = Textbox( self._fig, self._gs_algthm_output, max_display_size=config['algthm_output_max_display_size'], log_filename=self._log_filename, fontsize=config['algthm_output_fontsize'], font_family='monospace') self._cost_plotter = MeanPlotter(self._fig, self._gs_cost_plotter, color='blue', label='mean cost') self._gt_cost_plotter = MeanPlotter(self._fig, self._gs_gt_cost_plotter, color='red', label='ground truth cost') self._traj_visualizer = Plotter3D( self._fig, self._gs_traj_visualizer, num_plots=self._hyperparams['conditions']) if config['image_on']: self._image_visualizer = ImageVisualizer( self._fig, self._gs_image_visualizer, cropsize=config['image_size'], rostopic=config['image_topic'], show_overlay_buttons=True) # Setup GUI components. self._algthm_output.log_text('\n') self.set_output_text(self._hyperparams['info']) if config['initial_mode'] == 'run': self.run_mode() else: self.wait_mode() # Setup 3D Trajectory Visualizer plot titles and legends for m in range(self._hyperparams['conditions']): self._traj_visualizer.set_title(m, 'Condition %d' % (m)) self._traj_visualizer.add_legend(linestyle='-', marker='None', color='green', label='Trajectory Samples') self._traj_visualizer.add_legend(linestyle='-', marker='None', color='blue', label='Policy Samples') self._traj_visualizer.add_legend(linestyle='None', marker='x', color=(0.5, 0, 0), label='LG Controller Means') self._traj_visualizer.add_legend(linestyle='-', marker='None', color='red', label='LG Controller Distributions') self._fig.canvas.draw() # Display calculating thread def display_calculating(delay, run_event): while True: if not run_event.is_set(): run_event.wait() if run_event.is_set(): self.set_status_text('Calculating.') time.sleep(delay) if run_event.is_set(): self.set_status_text('Calculating..') time.sleep(delay) if run_event.is_set(): self.set_status_text('Calculating...') time.sleep(delay) self._calculating_run = threading.Event() self._calculating_thread = threading.Thread( target=display_calculating, args=(1, self._calculating_run)) self._calculating_thread.daemon = True self._calculating_thread.start()
def __init__(self, hyperparams, agent): self._hyperparams = hyperparams self._agent = agent self._log_filename = self._hyperparams['log_filename'] self._target_filename = self._hyperparams['target_filename'] self._num_targets = config['num_targets'] self._actuator_types = config['actuator_types'] self._actuator_names = config['actuator_names'] self._num_actuators = len(self._actuator_types) # Target Setup Status. self._target_number = 0 self._actuator_number = 0 self._actuator_type = self._actuator_types[self._actuator_number] self._actuator_name = self._actuator_names[self._actuator_number] self._initial_position = ('unknown', 'unknown', 'unknown') self._target_position = ('unknown', 'unknown', 'unknown') self._initial_image = None self._target_image = None self._mannequin_mode = False self._mm_process = None # Actions. actions_arr = [ Action('ptn', 'prev_target_number', self.prev_target_number, axis_pos=0), Action('ntn', 'next_target_number', self.next_target_number, axis_pos=1), Action('pat', 'prev_actuator_type', self.prev_actuator_type, axis_pos=2), Action('nat', 'next_actuator_type', self.next_actuator_type, axis_pos=3), Action('sip', 'set_initial_position', self.set_initial_position, axis_pos=4), Action('stp', 'set_target_position', self.set_target_position, axis_pos=5), Action('sii', 'set_initial_image', self.set_initial_image, axis_pos=6), Action('sti', 'set_target_image', self.set_target_image, axis_pos=7), Action('mti', 'move_to_initial', self.move_to_initial, axis_pos=8), Action('mtt', 'move_to_target', self.move_to_target, axis_pos=9), Action('rc', 'relax_controller', self.relax_controller, axis_pos=10), Action('mm', 'mannequin_mode', self.mannequin_mode, axis_pos=11), ] # Setup figure. plt.ion() plt.rcParams['toolbar'] = 'None' for key in plt.rcParams: if key.startswith('keymap.'): plt.rcParams[key] = '' self._fig = plt.figure(figsize=config['figsize']) self._fig.subplots_adjust(left=0.01, bottom=0.01, right=0.99, top=0.99, wspace=0, hspace=0) # Assign GUI component locations. self._gs = gridspec.GridSpec(4, 4) self._gs_action_panel = self._gs[0:1, 0:4] if config['image_on']: self._gs_target_output = self._gs[1:3, 0:2] self._gs_initial_image_visualizer = self._gs[3:4, 0:1] self._gs_target_image_visualizer = self._gs[3:4, 1:2] self._gs_action_output = self._gs[1:2, 2:4] self._gs_image_visualizer = self._gs[2:4, 2:4] else: self._gs_target_output = self._gs[1:4, 0:2] self._gs_action_output = self._gs[1:4, 2:4] # Create GUI components. self._action_panel = ActionPanel(self._fig, self._gs_action_panel, 3, 4, actions_arr) self._target_output = Textbox( self._fig, self._gs_target_output, log_filename=self._log_filename, fontsize=config['target_output_fontsize']) self._action_output = Textbox(self._fig, self._gs_action_output) if config['image_on']: self._initial_image_visualizer = ImageVisualizer( self._fig, self._gs_initial_image_visualizer) self._target_image_visualizer = ImageVisualizer( self._fig, self._gs_target_image_visualizer) self._image_visualizer = ImageVisualizer( self._fig, self._gs_image_visualizer, cropsize=config['image_size'], rostopic=config['image_topic'], show_overlay_buttons=True) # Setup GUI components. self.reload_positions() self.update_target_text() self.set_action_text('Press an action to begin.') self.set_action_bgcolor('white') self._fig.canvas.draw()
def __init__(self, hyperparams, agent): self._agent = agent self._hyperparams = hyperparams self._log_filename = self._hyperparams['log_filename'] if 'target_filename' in self._hyperparams: self._target_filename = self._hyperparams['target_filename'] else: self._target_filename = None # GPS Training Status. self.mode = config['initial_mode'] # Modes: run, wait, end, request, process. self.request = None # Requests: stop, reset, go, fail, None. self.err_msg = None self._colors = { 'run': 'cyan', 'wait': 'orange', 'end': 'red', } self._actuator_types = config['actuator_types'] self._actuator_names = config['actuator_names'] self._first_update = True self._actuator_number = 0 self._actuator_type = self._actuator_types[self._actuator_number] self._initial_position = ('unknown', 'unknown', 'unknown') self._target_position = ('unknown', 'unknown', 'unknown') # Actions. actions_arr = [ Action('stop', 'stop', self.request_stop, axis_pos=0), Action('reset', 'reset', self.request_reset, axis_pos=1), Action('GCM go', 'go', self.request_go, axis_pos=2), Action('transfer learning', 'transfer_learning', self.request_tl, axis_pos=3), Action('set initial state', 'initstate', self.request_init_state, axis_pos=4), Action('set goal state', 'goalstate', self.request_goal_state, axis_pos=5), Action('test transfer learning', 'test_tl', self.request_test_tl, axis_pos=6), Action('generalize', 'generalize', self.request_generalize, axis_pos=7), Action('mti', 'move_to_initial', self.move_to_initial, axis_pos=8), Action('mtt', 'move_to_target', self.move_to_target, axis_pos=9), Action('rc', 'relax_controller', self.relax_controller, axis_pos=10), ] # Setup figure. plt.ion() plt.rcParams['toolbar'] = 'None' for key in plt.rcParams: if key.startswith('keymap.'): plt.rcParams[key] = '' self._fig = plt.figure(figsize=config['figsize']) self._fig.subplots_adjust(left=0.01, bottom=0.01, right=0.99, top=0.99, wspace=0, hspace=0) # Assign GUI component locations. self._gs = gridspec.GridSpec(18, 8) self._gs_action_panel = self._gs[0:4, 0:8] self._gs_action_output = self._gs[4:5, 0:4] self._gs_status_output = self._gs[5:6, 0:4] self._gs_cost_plotter = self._gs[4:10, 4:8] self._gs_algthm_output = self._gs[6:10, 0:4] self._gs_traj_visualizer = self._gs[10:18, 0:8] # Create GUI components. self._action_panel = ActionPanel(self._fig, self._gs_action_panel, 3, 4, actions_arr) self._action_output = Textbox(self._fig, self._gs_action_output, border_on=True) self._status_output = Textbox(self._fig, self._gs_status_output, border_on=False) self._algthm_output = Textbox(self._fig, self._gs_algthm_output, max_display_size=config['algthm_output_max_display_size'], log_filename=self._log_filename, fontsize=config['algthm_output_fontsize'], font_family='monospace') self._cost_plotter = MeanPlotter(self._fig, self._gs_cost_plotter, color='blue', label='mean cost') self._traj_visualizer = Plotter3D(self._fig, self._gs_traj_visualizer, num_plots=self._hyperparams['conditions']) # Setup GUI components. self._algthm_output.log_text('\n') self.set_output_text(self._hyperparams['info']) if config['initial_mode'] == 'run': self.run_mode() else: self.wait_mode() # Setup 3D Trajectory Visualizer plot titles and legends for m in range(self._hyperparams['conditions']): self._traj_visualizer.set_title(m, 'Condition %d' % (m)) self._traj_visualizer.add_legend(linestyle='-', marker='None', color='green', label='Trajectory Samples') self._traj_visualizer.add_legend(linestyle='-', marker='None', color='blue', label='Policy Samples') self._traj_visualizer.add_legend(linestyle='None', marker='x', color=(0.5, 0, 0), label='LG Controller Means') self._traj_visualizer.add_legend(linestyle='-', marker='None', color='red', label='LG Controller Distributions') self._fig.canvas.draw() # Display calculating thread def display_calculating(delay, run_event): while True: if not run_event.is_set(): run_event.wait() if run_event.is_set(): self.set_status_text('Calculating.') time.sleep(delay) if run_event.is_set(): self.set_status_text('Calculating..') time.sleep(delay) if run_event.is_set(): self.set_status_text('Calculating...') time.sleep(delay) self._calculating_run = threading.Event() self._calculating_thread = threading.Thread(target=display_calculating, args=(1, self._calculating_run)) self._calculating_thread.daemon = True self._calculating_thread.start()
def __init__(self, fig, gs, cropsize=None, rostopic=None, show_overlay_buttons=False): """ If rostopic is given to this constructor, then the image visualizer will automatically update with rostopic image. Else, the update method must be manually called to supply images. """ # Real-time image self._t = 0 self._current_image = None self._crop_size = cropsize # Image overlay self._initial_image_overlay_on = False self._target_image_overlay_on = False self._initial_image = None self._initial_alpha = None self._target_image = None self._target_alpha = None self._default_image = np.zeros((1, 1, 3)) self._default_alpha = 0.0 # Actions actions_arr = [ Action('oii', 'overlay_initial_image', self.toggle_initial_image_overlay, axis_pos=0), Action('oti', 'overlay_target_image', self.toggle_target_image_overlay, axis_pos=1), ] # GUI Components self._fig = fig self._gs = gridspec.GridSpecFromSubplotSpec(8, 1, subplot_spec=gs) self._gs_action_panel = self._gs[0:1, 0] self._gs_image_axis = self._gs[1:8, 0] if show_overlay_buttons: self._action_panel = ActionPanel(self._fig, self._gs_action_panel, 1, 2, actions_arr) self._ax_image = plt.subplot(self._gs_image_axis) self._ax_image.set_axis_off() self._plot = self._ax_image.imshow(self._default_image) self._overlay_plot_initial = self._ax_image.imshow( self._default_image, alpha=self._default_alpha) self._overlay_plot_target = self._ax_image.imshow( self._default_image, alpha=self._default_alpha) self._fig.canvas.draw() self._fig.canvas.flush_events() # Fixes bug with Qt4Agg backend # ROS subscriber for PS3 controller if rostopic and ROS_ENABLED: rospy.Subscriber(rostopic, Image, self.update_ros, queue_size=1, buff_size=2**24)
# Initialize Figure fig = plt.figure() gs = gridspec.GridSpec(2, 3) # Action Panel number = 0 def plus_1(event=None): global number; number += 1; print(number) def plus_2(event=None): global number; number += 2; print(number) def mult_4(event=None): global number; number *= 4; print(number) actions_arr = [ Action('plus1', 'plus1', plus_1, axis_pos=0, keyboard_binding='1', ps3_binding=None), Action('plus2', 'plus2', plus_2, axis_pos=1, keyboard_binding='2', ps3_binding=None), Action('print', 'print', mult_4, axis_pos=2, keyboard_binding='4', ps3_binding=None), ] action_panel = ActionPanel(fig, gs[0], 3, 1, actions_arr) # Textbox def demo_textbox(): max_i = 20 for i in range(max_i): textbox.append_text(str(i)) c = 0.5 + 0.5*i/max_i textbox.set_bgcolor((c, c, c)) time.sleep(1) textbox = Textbox(fig, gs[1], max_display_size=10, log_filename=None) run_demo(demo_textbox) # Image Visualizer def demo_image_visualizer():