add linear vel calibration, refactor base_vel proprocessing in utils.py

这个提交包含在:
Zipeng Fu
2023-10-25 15:10:08 -04:00
父节点 26a457ab4e
当前提交 b75a32467b

查看文件

@ -29,10 +29,8 @@ class EpisodicDataset(torch.utils.data.Dataset):
is_sim = root.attrs['sim'] is_sim = root.attrs['sim']
if '/base_action' in root: if '/base_action' in root:
base_action = root['/base_action'][()] base_action = root['/base_action'][()]
smoothed_base_action = np.stack([ base_action = preprocess_base_action(base_action)
np.convolve(base_action[:, i], np.ones(20)/20, mode='same') for i in range(base_action.shape[1]) action = np.concatenate([root['/action'][()], base_action], axis=-1)
], axis=-1, dtype=np.float32)
action = np.concatenate([root['/action'][()], smoothed_base_action], axis=-1)
else: else:
action = root['/action'][()] action = root['/action'][()]
original_action_shape = action.shape original_action_shape = action.shape
@ -94,10 +92,8 @@ def get_norm_stats(dataset_dir, num_episodes):
qpos = root['/observations/qpos'][()] qpos = root['/observations/qpos'][()]
qvel = root['/observations/qvel'][()] qvel = root['/observations/qvel'][()]
base_action = root['/base_action'][()] base_action = root['/base_action'][()]
smoothed_base_action = np.stack([ base_action = preprocess_base_action(base_action)
np.convolve(base_action[:, i], np.ones(20)/20, mode='same') for i in range(base_action.shape[1]) action = np.concatenate([root['/action'][()], base_action], axis=-1)
], axis=-1, dtype=np.float32)
action = np.concatenate([root['/action'][()], smoothed_base_action], axis=-1)
except: except:
print(f'Error loading {dataset_path}') print(f'Error loading {dataset_path}')
quit() quit()
@ -138,11 +134,28 @@ def load_data(dataset_dir, num_episodes, camera_names, batch_size_train, batch_s
# construct dataset and dataloader # construct dataset and dataloader
train_dataset = EpisodicDataset(train_indices, dataset_dir, camera_names, norm_stats) train_dataset = EpisodicDataset(train_indices, dataset_dir, camera_names, norm_stats)
val_dataset = EpisodicDataset(val_indices, dataset_dir, camera_names, norm_stats) val_dataset = EpisodicDataset(val_indices, dataset_dir, camera_names, norm_stats)
train_dataloader = DataLoader(train_dataset, batch_size=batch_size_train, shuffle=True, pin_memory=True, num_workers=1, prefetch_factor=1) train_dataloader = DataLoader(train_dataset, batch_size=batch_size_train, shuffle=True, pin_memory=True, num_workers=1, prefetch_factor=1, persistent_workers=True)
val_dataloader = DataLoader(val_dataset, batch_size=batch_size_val, shuffle=True, pin_memory=True, num_workers=1, prefetch_factor=1) val_dataloader = DataLoader(val_dataset, batch_size=batch_size_val, shuffle=True, pin_memory=True, num_workers=1, prefetch_factor=1, persistent_workers=True)
return train_dataloader, val_dataloader, norm_stats, train_dataset.is_sim return train_dataloader, val_dataloader, norm_stats, train_dataset.is_sim
def calibrate_linear_vel(base_action):
c = 0.19
v = base_action[:, 0]
w = base_action[:, 1]
base_action[:, 0] = v - c * w
return base_action
def smooth_base_action(base_action):
return np.stack([
np.convolve(base_action[:, i], np.ones(20)/20, mode='same') for i in range(base_action.shape[1])
], axis=-1, dtype=np.float32)
def preprocess_base_action(base_action):
base_action = calibrate_linear_vel(base_action)
base_action = smooth_base_action(base_action)
return base_action
### env utils ### env utils