class Layer():
def __init__(self, layer_number, FLAGS, env, sess, agent_params):
self.layer_number = layer_number
self.FLAGS = FLAGS
self.sess = sess
# Set time limit for each layer. If agent uses only 1 layer, time limit is the max number of low-level actions allowed in the episode (i.e, env.max_actions).
if FLAGS.layers > 1:
self.time_limit = FLAGS.time_scale
else:
self.time_limit = env.max_actions
self.current_state = None
self.goal = None
# Initialize Replay Buffer. Below variables determine size of replay buffer.
# Ceiling on buffer size
self.buffer_size_ceiling = 10**7
# Number of full episodes stored in replay buffer
self.episodes_to_store = agent_params["episodes_to_store"]
# Set number of transitions to serve as replay goals during goal replay
self.num_replay_goals = 3
# Number of the transitions created for each attempt (i.e, action replay + goal replay + subgoal testing)
if self.layer_number == 0:
self.trans_per_attempt = (1 + self.num_replay_goals) * self.time_limit
else:
self.trans_per_attempt = (1 + self.num_replay_goals) * self.time_limit + int(self.time_limit/3)
# Buffer size = transitions per attempt * # attempts per episode * num of episodes stored
self.buffer_size = min(self.trans_per_attempt * self.time_limit**(self.FLAGS.layers-1 - self.layer_number) * self.episodes_to_store, self.buffer_size_ceiling)
# self.buffer_size = 10000000
self.batch_size = 1024
self.replay_buffer = ExperienceBuffer(self.buffer_size, self.batch_size)
# Create buffer to store not yet finalized goal replay transitions
self.temp_goal_replay_storage = []
# Initialize actor and critic networks
self.actor = Actor(sess, env, self.batch_size, self.layer_number, FLAGS)
self.critic = Critic(sess, env, self.layer_number, FLAGS)
# Parameter determines degree of noise added to actions during training
# self.noise_perc = noise_perc
if self.layer_number == 0:
self.noise_perc = agent_params["atomic_noise"]
else:
self.noise_perc = agent_params["subgoal_noise"]
# Create flag to indicate when layer has ran out of attempts to achieve goal. This will be important for subgoal testing
self.maxed_out = False
self.subgoal_penalty = agent_params["subgoal_penalty"]
# Add noise to provided action
def add_noise(self,action, env):
# Noise added will be percentage of range
if self.layer_number == 0:
action_bounds = env.action_bounds
action_offset = env.action_offset
else:
action_bounds = env.subgoal_bounds_symmetric
action_offset = env.subgoal_bounds_offset
assert len(action) == len(action_bounds), "Action bounds must have same dimension as action"
assert len(action) == len(self.noise_perc), "Noise percentage vector must have same dimension as action"
# Add noise to action and ensure remains within bounds
for i in range(len(action)):
action[i] += np.random.normal(0,self.noise_perc[i] * action_bounds[i])
action[i] = max(min(action[i], action_bounds[i]+action_offset[i]), -action_bounds[i]+action_offset[i])
return action
# Select random action
def get_random_action(self, env):
if self.layer_number == 0:
action = np.zeros((env.action_dim))
else:
action = np.zeros((env.subgoal_dim))
# Each dimension of random action should take some value in the dimension's range
for i in range(len(action)):
if self.layer_number == 0:
action[i] = np.random.uniform(-env.action_bounds[i] + env.action_offset[i], env.action_bounds[i] + env.action_offset[i])
else:
action[i] = np.random.uniform(env.subgoal_bounds[i][0],env.subgoal_bounds[i][1])
return action
# Function selects action using an epsilon-greedy policy
def choose_action(self,agent, env, subgoal_test):
# If testing mode or testing subgoals, action is output of actor network without noise
if agent.FLAGS.test or subgoal_test:
# return self.actor.get_action(np.reshape(self.current_state,(1,len(self.current_state))), np.reshape(self.goal,(1,len(self.goal))))[0], "Policy", subgoal_test
return self.get_actions(obs['observation'], obs['achieved_goal'], obs['desired_goal'])
else:
if np.random.random_sample() > 0.2:
# Choose noisy action
action = self.add_noise(self.actor.get_action(np.reshape(self.current_state,(1,len(self.current_state))), np.reshape(self.goal,(1,len(self.goal))))[0],env)
action_type = "Noisy Policy"
# Otherwise, choose random action
else:
action = self.get_random_action(env)
action_type = "Random"
# Determine whether to test upcoming subgoal
if np.random.random_sample() < agent.subgoal_test_perc:
next_subgoal_test = True
else:
next_subgoal_test = False
return action, action_type, next_subgoal_test
# Create action replay transition by evaluating hindsight action given original goal
def perform_action_replay(self, hindsight_action, next_state, goal_status):
# Determine reward (0 if goal achieved, -1 otherwise) and finished boolean. The finished boolean is used for determining the target for Q-value updates
if goal_status[self.layer_number]:
reward = 0
finished = True
else:
reward = -1
finished = False
# Transition will take the form [old state, hindsight_action, reward, next_state, goal, terminate boolean, None]
transition = [self.current_state, hindsight_action, reward, next_state, self.goal, finished, None]
# print("AR Trans: ", transition)
# Add action replay transition to layer's replay buffer
self.replay_buffer.add(np.copy(transition))
# Create initial goal replay transitions
def create_prelim_goal_replay_trans(self, hindsight_action, next_state, env, total_layers):
# Create transition evaluating hindsight action for some goal to be determined in future. Goal will be ultimately be selected from states layer has traversed through. Transition will be in the form [old state, hindsight action, reward = None, next state, goal = None, finished = None, next state projeted to subgoal/end goal space]
if self.layer_number == total_layers - 1:
hindsight_goal = env.project_state_to_end_goal(env.sim, next_state)
else:
hindsight_goal = env.project_state_to_subgoal(env.sim, next_state)
transition = [self.current_state, hindsight_action, None, next_state, None, None, hindsight_goal]
# print("\nPrelim GR A: ", transition)
self.temp_goal_replay_storage.append(np.copy(transition))
"""
# Designer can create some additional goal replay transitions. For instance, higher level transitions can be replayed with the subgoal achieved in hindsight as the original goal.
if self.layer_number > 0:
transition_b = [self.current_state, hindsight_action, 0, next_state, hindsight_goal, True, None]
# print("\nGoal Replay B: ", transition_b)
self.replay_buffer.add(np.copy(transition_b))
"""
# Return reward given provided goal and goal achieved in hindsight
def get_reward(self,new_goal, hindsight_goal, goal_thresholds):
assert len(new_goal) == len(hindsight_goal) == len(goal_thresholds), "Goal, hindsight goal, and goal thresholds do not have same dimensions"
# If the difference in any dimension is greater than threshold, goal not achieved
for i in range(len(new_goal)):
if np.absolute(new_goal[i]-hindsight_goal[i]) > goal_thresholds[i]:
return -1
# Else goal is achieved
return 0
# Finalize goal replay by filling in goal, reward, and finished boolean for the preliminary goal replay transitions created before
def finalize_goal_replay(self,goal_thresholds):
# Choose transitions to serve as goals during goal replay. The last transition will always be used
num_trans = len(self.temp_goal_replay_storage)
num_replay_goals = self.num_replay_goals
# If fewer transitions that ordinary number of replay goals, lower number of replay goals
if num_trans < self.num_replay_goals:
num_replay_goals = num_trans
"""
if self.layer_number == 1:
print("\n\nPerforming Goal Replay\n\n")
print("Num Trans: ", num_trans, ", Num Replay Goals: ", num_replay_goals)
"""
indices = np.zeros((num_replay_goals))
indices[:num_replay_goals-1] = np.random.randint(num_trans,size=num_replay_goals-1)
indices[num_replay_goals-1] = num_trans - 1
indices = np.sort(indices)
# if self.layer_number == 1:
# print("Selected Indices: ", indices)
# For each selected transition, update the goal dimension of the selected transition and all prior transitions by using the next state of the selected transition as the new goal. Given new goal, update the reward and finished boolean as well.
for i in range(len(indices)):
trans_copy = np.copy(self.temp_goal_replay_storage)
# if self.layer_number == 1:
# print("GR Iteration: %d, Index %d" % (i, indices[i]))
new_goal = trans_copy[int(indices[i])][6]
# for index in range(int(indices[i])+1):
for index in range(num_trans):
# Update goal to new goal
trans_copy[index][4] = new_goal
# Update reward
trans_copy[index][2] = self.get_reward(new_goal, trans_copy[index][6], goal_thresholds)
# Update finished boolean based on reward
if trans_copy[index][2] == 0:
trans_copy[index][5] = True
else:
trans_copy[index][5] = False
# Add finished transition to replay buffer
# if self.layer_number == 1:
# print("\nNew Goal: ", new_goal)
# print("Upd Trans %d: " % index, trans_copy[index])
self.replay_buffer.add(trans_copy[index])
# Clear storage for preliminary goal replay transitions at end of goal replay
self.temp_goal_replay_storage = []
# Create transition penalizing subgoal if necessary. The target Q-value when this transition is used will ignore next state as the finished boolena = True. Change the finished boolean to False, if you would like the subgoal penalty to depend on the next state.
def penalize_subgoal(self, subgoal, next_state, high_level_goal_achieved):
transition = [self.current_state, subgoal, self.subgoal_penalty, next_state, self.goal, True, None]
self.replay_buffer.add(np.copy(transition))
# Determine whether layer is finished training
def return_to_higher_level(self, max_lay_achieved, agent, env, attempts_made):
# Return to higher level if (i) a higher level goal has been reached, (ii) maxed out episode time steps (env.max_actions), (iii) not testing and layer is out of attempts, and (iv) testing, layer is not the highest level, and layer is out of attempts. NOTE: during testing, highest level will continue to ouput subgoals until either (i) the maximum number of episdoe time steps or (ii) the end goal has been achieved.
# Return to previous level when any higher level goal achieved. NOTE: if not testing and agent achieves end goal, training will continue until out of time (i.e., out of time steps or highest level runs out of attempts). This will allow agent to experience being around the end goal.
if max_lay_achieved is not None and max_lay_achieved >= self.layer_number:
return True
# Return when out of time
elif agent.steps_taken >= env.max_actions:
return True
# Return when layer has maxed out attempts
elif not agent.FLAGS.test and attempts_made >= self.time_limit:
return True
# NOTE: During testing, agent will have env.max_action attempts to achieve goal
elif agent.FLAGS.test and self.layer_number < agent.FLAGS.layers-1 and attempts_made >= self.time_limit:
return True
else:
return False
# Learn to achieve goals with actions belonging to appropriate time scale.
# "goal_array" contains the goal states for the current layer and all higher layers
def train(self, agent, env, subgoal_test = False, episode_num = None):
# print("\nTraining Layer %d" % self.layer_number)
# Set layer's current state and new goal state
self.goal = agent.goal_array[self.layer_number]
self.current_state = agent.current_state
# Reset flag indicating whether layer has ran out of attempts. This will be used for subgoal testing.
self.maxed_out = False
# Display all subgoals if visualizing training and current layer is bottom layer
if self.layer_number == 0 and agent.FLAGS.show and agent.FLAGS.layers > 1:
env.display_subgoals(agent.goal_array)
# env.sim.data.mocap_pos[3] = env.project_state_to_end_goal(env.sim,self.current_state)
# print("Subgoal Pos: ", env.sim.data.mocap_pos[1])
# Current layer has self.time_limit attempts to each its goal state.
attempts_made = 0
while True:
# Select action to achieve goal state using epsilon-greedy policy or greedy policy if in test mode
action, action_type, next_subgoal_test = self.choose_action(agent, env, subgoal_test)
"""
if self.layer_number == agent.FLAGS.layers - 1:
# print("\nLayer %d Action: " % self.layer_number, action)
print("Q-Value: ", self.critic.get_Q_value(np.reshape(self.current_state,(1,len(self.current_state))), np.reshape(self.goal,(1,len(self.goal))), np.reshape(action,(1,len(action)))))
"""
# If next layer is not bottom level, propose subgoal for next layer to achieve and determine whether that subgoal should be tested
if self.layer_number > 0:
agent.goal_array[self.layer_number - 1] = action ## 액션을 그냥 골로 만들어줌?
goal_status, max_lay_achieved = agent.layers[self.layer_number - 1].train(agent, env, next_subgoal_test, episode_num)
# If layer is bottom level, execute low-level action
else:
next_state = env.execute_action(action)
# Increment steps taken
agent.steps_taken += 1
# print("Num Actions Taken: ", agent.steps_taken)
if agent.steps_taken >= env.max_actions:
print("Out of actions (Steps: %d)" % agent.steps_taken)
agent.current_state = next_state
# Determine whether any of the goals from any layer was achieved and, if applicable, the highest layer whose goal was achieved
goal_status, max_lay_achieved = agent.check_goals(env)
attempts_made += 1
# Print if goal from current layer as been achieved
if goal_status[self.layer_number]:
if self.layer_number < agent.FLAGS.layers - 1:
print("SUBGOAL ACHIEVED")
print("\nEpisode %d, Layer %d, Attempt %d Goal Achieved" % (episode_num, self.layer_number, attempts_made))
print("Goal: ", self.goal)
if self.layer_number == agent.FLAGS.layers - 1:
print("Hindsight Goal: ", env.project_state_to_end_goal(env.sim, agent.current_state))
else:
print("Hindsight Goal: ", env.project_state_to_subgoal(env.sim, agent.current_state))
# Perform hindsight learning using action actually executed (low-level action or hindsight subgoal)
if self.layer_number == 0:
hindsight_action = action
else:
# If subgoal action was achieved by layer below, use this as hindsight action
if goal_status[self.layer_number-1]:
hindsight_action = action
# Otherwise, use subgoal that was achieved in hindsight
else:
hindsight_action = env.project_state_to_subgoal(env.sim, agent.current_state)
# Next, create hindsight transitions if not testing
if not agent.FLAGS.test:
# Create action replay transition by evaluating hindsight action given current goal
self.perform_action_replay(hindsight_action, agent.current_state, goal_status)
# Create preliminary goal replay transitions. The goal and reward in these transitions will be finalized when this layer has run out of attempts or the goal has been achieved.
self.create_prelim_goal_replay_trans(hindsight_action, agent.current_state, env, agent.FLAGS.layers)
# Penalize subgoals if subgoal testing and subgoal was missed by lower layers after maximum number of attempts
if self.layer_number > 0 and next_subgoal_test and agent.layers[self.layer_number-1].maxed_out:
self.penalize_subgoal(action, agent.current_state, goal_status[self.layer_number])
# Print summary of transition
if agent.FLAGS.verbose:
print("\nEpisode %d, Training Layer %d, Attempt %d" % (episode_num, self.layer_number,attempts_made))
# print("Goal Array: ", agent.goal_array, "Max Lay Achieved: ", max_lay_achieved)
print("Old State: ", self.current_state)
print("Hindsight Action: ", hindsight_action)
print("Original Action: ", action)
print("Next State: ", agent.current_state)
print("Goal: ", self.goal)
if self.layer_number == agent.FLAGS.layers - 1:
print("Hindsight Goal: ", env.project_state_to_end_goal(env.sim, agent.current_state))
else:
print("Hindsight Goal: ", env.project_state_to_subgoal(env.sim, agent.current_state))
print("Goal Status: ", goal_status, "\n")
print("All Goals: ", agent.goal_array)
# Update state of current layer
self.current_state = agent.current_state
# Return to previous level to receive next subgoal if applicable
# if self.return_to_higher_level(max_lay_achieved, agent, env, attempts_made):
if (max_lay_achieved is not None and max_lay_achieved >= self.layer_number) or agent.steps_taken >= env.max_actions or attempts_made >= self.time_limit:
if self.layer_number == agent.FLAGS.layers-1:
print("HL Attempts Made: ", attempts_made)
# If goal was not achieved after max number of attempts, set maxed out flag to true
if attempts_made >= self.time_limit and not goal_status[self.layer_number]:
self.maxed_out = True
# print("Layer %d Out of Attempts" % self.layer_number)
# If not testing, finish goal replay by filling in missing goal and reward values before returning to prior level.
if not agent.FLAGS.test:
if self.layer_number == agent.FLAGS.layers - 1:
goal_thresholds = env.end_goal_thresholds
else:
goal_thresholds = env.subgoal_thresholds
self.finalize_goal_replay(goal_thresholds)
# Under certain circumstances, the highest layer will not seek a new end goal
if self.return_to_higher_level(max_lay_achieved, agent, env, attempts_made):
return goal_status, max_lay_achieved
# Update actor and critic networks
def learn(self, num_updates):
for _ in range(num_updates):
# Update weights of non-target networks
if self.replay_buffer.size >= self.batch_size:
old_states, actions, rewards, new_states, goals, is_terminals = self.replay_buffer.get_batch()
self.critic.update(old_states, actions, rewards, new_states, goals, self.actor.get_action(new_states,goals), is_terminals)
action_derivs = self.critic.get_gradients(old_states, goals, self.actor.get_action(old_states, goals))
self.actor.update(old_states, goals, action_derivs)
"""
def run(num_episodes, buf_size):
# initializing the parameters for the AC network
e = 0.1
total_steps = 0
pre_train_steps = 1000
update_freq = 500
batch_size = 32
# initializing the HFO environment
env = LowLevelRandomAgent()
state_space_dim = env.getStateSize()
action_space_dim = env.action_space.n
# initializing the experienc_replay buffer
exp_buf = Memory(buf_size)
with tf.Session() as sess:
# initializing the actor and the critic networks
actor = Actor(sess,
num_inputs=state_space_dim,
num_actions=action_space_dim,
num_params=env.action_space.params)
critic = Critic(sess,
state_size=state_space_dim,
action_size=action_space_dim,
param_size=env.action_space.params,
num_outputs=1)
# calling the variable initter AFTER the init of the networks
init = tf.global_variables_initializer()
sess.run(init)
#TODO : CHANGED PREDICT TO OUTPUT NOT ARGMAX BUT ALL ACTIONS
# DO THE MAX FUCNTION SOMEWHERE HERE
# setting the initial variables for the HFO environments
for x in range(num_episodes):
total_reward = 0
s = env.reset()
done = False
t_buf = Memory(100)
for x in range(100):
#TODO : random action according to boltzmann thin in Caitlin's paper
#TODO : something with random noise (see code about DDPG)
actions, params = actor.predict(s)
action, best_params = get_param_from_action(
actions[0], params[0], env.action_space)
#TODO coubts about wether this return what I expect
best_action = env.action_space[action]
best_action[1:] = best_params
s1, reward, done = env.step_raw(best_action)
t_buf.add([s, action, reward, s1, done])
# update the network with batches of experience
if total_steps > pre_train_steps:
if total_steps % update_freq == 0:
# retrieving batches of experiences from the memory buffer
update_batch = np.array(
exp_buf.get_batch(batch_size)).reshape(
(batch_size, 5))
actor_inputs = np.vstack(update_batch[:, 0])
actor_outputs = actor.predict(actor_inputs)
c_actor_outputs = tf.concat(
(actor_outputs[0], actor_outputs[1]), axis=1)
#critic_inputs = tf.concat((actor_inputs, c_actor_outputs), axis=1)
#critic_output = critic.predict(critic_inputs.eval())
grads = critic.get_gradients(actor_inputs,
actor_outputs[0],
actor_outputs[1])
print np.array(grads)
actor.train(actor_inputs, grads)
if done:
break
s = s1
total_steps += 1
for item in t_buf._data:
exp_buf.add(item)
