Refactor SAC configuration and policy to support discrete actions

- Removed GraspCriticNetworkConfig class and integrated its parameters into SACConfig.
- Added num_discrete_actions parameter to SACConfig for better action handling.
- Updated SACPolicy to conditionally create grasp critic networks based on num_discrete_actions.
- Enhanced grasp critic forward pass to handle discrete actions and compute losses accordingly.
This commit is contained in:
AdilZouitine 2025-04-01 09:30:32 +00:00
parent fe2ff516a8
commit 6a215f47dd
2 changed files with 68 additions and 44 deletions

View File

@ -42,12 +42,6 @@ class CriticNetworkConfig:
final_activation: str | None = None final_activation: str | None = None
@dataclass
class GraspCriticNetworkConfig:
hidden_dims: list[int] = field(default_factory=lambda: [256, 256])
activate_final: bool = True
final_activation: str | None = None
output_dim: int = 3
@dataclass @dataclass
@ -152,6 +146,7 @@ class SACConfig(PreTrainedConfig):
freeze_vision_encoder: bool = True freeze_vision_encoder: bool = True
image_encoder_hidden_dim: int = 32 image_encoder_hidden_dim: int = 32
shared_encoder: bool = True shared_encoder: bool = True
num_discrete_actions: int | None = None
# Training parameter # Training parameter
online_steps: int = 1000000 online_steps: int = 1000000
@ -182,7 +177,7 @@ class SACConfig(PreTrainedConfig):
critic_network_kwargs: CriticNetworkConfig = field(default_factory=CriticNetworkConfig) critic_network_kwargs: CriticNetworkConfig = field(default_factory=CriticNetworkConfig)
actor_network_kwargs: ActorNetworkConfig = field(default_factory=ActorNetworkConfig) actor_network_kwargs: ActorNetworkConfig = field(default_factory=ActorNetworkConfig)
policy_kwargs: PolicyConfig = field(default_factory=PolicyConfig) policy_kwargs: PolicyConfig = field(default_factory=PolicyConfig)
grasp_critic_network_kwargs: CriticNetworkConfig = field(default_factory=CriticNetworkConfig)
actor_learner_config: ActorLearnerConfig = field(default_factory=ActorLearnerConfig) actor_learner_config: ActorLearnerConfig = field(default_factory=ActorLearnerConfig)
concurrency: ConcurrencyConfig = field(default_factory=ConcurrencyConfig) concurrency: ConcurrencyConfig = field(default_factory=ConcurrencyConfig)

View File

@ -33,6 +33,7 @@ from lerobot.common.policies.pretrained import PreTrainedPolicy
from lerobot.common.policies.sac.configuration_sac import SACConfig from lerobot.common.policies.sac.configuration_sac import SACConfig
from lerobot.common.policies.utils import get_device_from_parameters from lerobot.common.policies.utils import get_device_from_parameters
DISCRETE_DIMENSION_INDEX = -1
class SACPolicy( class SACPolicy(
PreTrainedPolicy, PreTrainedPolicy,
@ -113,18 +114,24 @@ class SACPolicy(
self.critic_ensemble = torch.compile(self.critic_ensemble) self.critic_ensemble = torch.compile(self.critic_ensemble)
self.critic_target = torch.compile(self.critic_target) self.critic_target = torch.compile(self.critic_target)
self.grasp_critic = None
self.grasp_critic_target = None
if config.num_discrete_actions is not None:
# Create grasp critic # Create grasp critic
self.grasp_critic = GraspCritic( self.grasp_critic = GraspCritic(
encoder=encoder_critic, encoder=encoder_critic,
input_dim=encoder_critic.output_dim, input_dim=encoder_critic.output_dim,
**config.grasp_critic_network_kwargs, output_dim=config.num_discrete_actions,
**asdict(config.grasp_critic_network_kwargs),
) )
# Create target grasp critic # Create target grasp critic
self.grasp_critic_target = GraspCritic( self.grasp_critic_target = GraspCritic(
encoder=encoder_critic, encoder=encoder_critic,
input_dim=encoder_critic.output_dim, input_dim=encoder_critic.output_dim,
**config.grasp_critic_network_kwargs, output_dim=config.num_discrete_actions,
**asdict(config.grasp_critic_network_kwargs),
) )
self.grasp_critic_target.load_state_dict(self.grasp_critic.state_dict()) self.grasp_critic_target.load_state_dict(self.grasp_critic.state_dict())
@ -173,6 +180,12 @@ class SACPolicy(
"""Select action for inference/evaluation""" """Select action for inference/evaluation"""
actions, _, _ = self.actor(batch) actions, _, _ = self.actor(batch)
actions = self.unnormalize_outputs({"action": actions})["action"] actions = self.unnormalize_outputs({"action": actions})["action"]
if self.config.num_discrete_actions is not None:
discrete_action_value = self.grasp_critic(batch)
discrete_action = torch.argmax(discrete_action_value, dim=-1)
actions = torch.cat([actions, discrete_action], dim=-1)
return actions return actions
def critic_forward( def critic_forward(
@ -192,11 +205,12 @@ class SACPolicy(
Returns: Returns:
Tensor of Q-values from all critics Tensor of Q-values from all critics
""" """
critics = self.critic_target if use_target else self.critic_ensemble critics = self.critic_target if use_target else self.critic_ensemble
q_values = critics(observations, actions, observation_features) q_values = critics(observations, actions, observation_features)
return q_values return q_values
def grasp_critic_forward(self, observations, use_target=False, observation_features=None): def grasp_critic_forward(self, observations, use_target=False, observation_features=None) -> torch.Tensor:
"""Forward pass through a grasp critic network """Forward pass through a grasp critic network
Args: Args:
@ -256,9 +270,6 @@ class SACPolicy(
) )
if model == "grasp_critic": if model == "grasp_critic":
# Extract grasp_critic-specific components
complementary_info: dict[str, Tensor] = batch["complementary_info"]
return self.compute_loss_grasp_critic( return self.compute_loss_grasp_critic(
observations=observations, observations=observations,
actions=actions, actions=actions,
@ -267,7 +278,6 @@ class SACPolicy(
done=done, done=done,
observation_features=observation_features, observation_features=observation_features,
next_observation_features=next_observation_features, next_observation_features=next_observation_features,
complementary_info=complementary_info,
) )
if model == "actor": if model == "actor":
@ -349,6 +359,12 @@ class SACPolicy(
td_target = rewards + (1 - done) * self.config.discount * min_q td_target = rewards + (1 - done) * self.config.discount * min_q
# 3- compute predicted qs # 3- compute predicted qs
if self.config.num_discrete_actions is not None:
# NOTE: We only want to keep the continuous action part
# In the buffer we have the full action space (continuous + discrete)
# We need to split them before concatenating them in the critic forward
actions: Tensor = actions[:, :DISCRETE_DIMENSION_INDEX]
q_preds = self.critic_forward( q_preds = self.critic_forward(
observations=observations, observations=observations,
actions=actions, actions=actions,
@ -378,30 +394,43 @@ class SACPolicy(
done, done,
observation_features=None, observation_features=None,
next_observation_features=None, next_observation_features=None,
complementary_info=None,
): ):
batch_size = rewards.shape[0] # NOTE: We only want to keep the discrete action part
grasp_actions = torch.clip(actions[:, -1].long() + 1, 0, 2) # Map [-1, 0, 1] -> [0, 1, 2] # In the buffer we have the full action space (continuous + discrete)
# We need to split them before concatenating them in the critic forward
actions: Tensor = actions[:, DISCRETE_DIMENSION_INDEX:]
actions = actions.long()
with torch.no_grad(): with torch.no_grad():
# For DQN, select actions using online network, evaluate with target network
next_grasp_qs = self.grasp_critic_forward(next_observations, use_target=False) next_grasp_qs = self.grasp_critic_forward(next_observations, use_target=False)
best_next_grasp_action = torch.argmax(next_grasp_qs, dim=-1) best_next_grasp_action = torch.argmax(next_grasp_qs, dim=-1)
target_next_grasp_qs = self.grasp_critic_forward(next_observations, use_target=True) # Get target Q-values from target network
target_next_grasp_q = target_next_grasp_qs[torch.arange(batch_size), best_next_grasp_action] target_next_grasp_qs = self.grasp_critic_forward(observations=next_observations, use_target=True)
# Get the grasp penalty from complementary_info # Use gather to select Q-values for best actions
grasp_penalty = torch.zeros_like(rewards) target_next_grasp_q = torch.gather(
if complementary_info is not None and "grasp_penalty" in complementary_info: target_next_grasp_qs,
grasp_penalty = complementary_info["grasp_penalty"] dim=1,
index=best_next_grasp_action.unsqueeze(-1)
).squeeze(-1)
grasp_rewards = rewards + grasp_penalty # Compute target Q-value with Bellman equation
target_grasp_q = grasp_rewards + (1 - done) * self.config.discount * target_next_grasp_q target_grasp_q = rewards + (1 - done) * self.config.discount * target_next_grasp_q
predicted_grasp_qs = self.grasp_critic_forward(observations, use_target=False) # Get predicted Q-values for current observations
predicted_grasp_q = predicted_grasp_qs[torch.arange(batch_size), grasp_actions] predicted_grasp_qs = self.grasp_critic_forward(observations=observations, use_target=False)
grasp_critic_loss = F.mse_loss(input=predicted_grasp_q, target=target_grasp_q, reduction="mean") # Use gather to select Q-values for taken actions
predicted_grasp_q = torch.gather(
predicted_grasp_qs,
dim=1,
index=actions.unsqueeze(-1)
).squeeze(-1)
# Compute MSE loss between predicted and target Q-values
grasp_critic_loss = F.mse_loss(input=predicted_grasp_q, target=target_grasp_q)
return grasp_critic_loss return grasp_critic_loss
def compute_loss_temperature(self, observations, observation_features: Tensor | None = None) -> Tensor: def compute_loss_temperature(self, observations, observation_features: Tensor | None = None) -> Tensor:
@ -611,7 +640,7 @@ class GraspCritic(nn.Module):
self, self,
encoder: Optional[nn.Module], encoder: Optional[nn.Module],
network: nn.Module, network: nn.Module,
output_dim: int = 3, output_dim: int = 3, # TODO (azouitine): rename it number of discret acitons smth like that
init_final: Optional[float] = None, init_final: Optional[float] = None,
encoder_is_shared: bool = False, encoder_is_shared: bool = False,
): ):