GMU-vision-robotics / View-Invariant-Visual-Servoing-for-Navigation

code for paper 'Learning View and Target Invariant Visual Servoing for Navigation'
11 stars 0 forks source link

Could not able to find util module #1

Open abj247 opened 9 months ago

abj247 commented 9 months ago

In the sample_image_pairs_with_common_area.py and train_DQN_vs_overlap.py, there is an attempt to import some functions from util package and util_ddpg package from util import action2pose, func_pose2posAndorn, plus_theta_fn, minus_theta_fn, similar_location_under_certainThreshold from utils_ddpg import buildActionMapper, update_current_pose but I am not able to find this util module or related file in the repo. How can I fix this issue?

image

Thanks!

yimengli46 commented 9 months ago
def func_pose2posAndorn (pose, z):
    x, y, theta = pose
    return (x, y, z), theta

def minus_theta_fn(previous_theta, current_theta):
    """ compute angle current_theta minus angle previous theta."""
    result = current_theta - previous_theta
    if result < -math.pi:
        result += 2 * math.pi
    if result > math.pi:
        result -= 2 * math.pi
    return result

def plus_theta_fn(previous_theta, current_theta):
    """ compute angle current_theta plus angle previous theta."""
    result = current_theta + previous_theta
    if result < -math.pi:
        result += 2 * math.pi
    if result > math.pi:
        result -= 2 * math.pi
    return result