add linear vel calibration, refactor base_vel proprocessing in utils.py
这个提交包含在:
33
utils.py
33
utils.py
@ -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
|
||||||
|
|
||||||
|
|||||||
在新工单中引用
屏蔽一个用户