devendrachaplot/Neural-SLAM

What kinds of coordinate using by the Neural-SLAM and Habitat?

GuoPingPan opened this issue · 1 comments

I am confused about the coordinate between neural-slam and habitat.
Can you tell me what is the coordinate of the agent in neural-slam and the difference with habitat?
I also want to know the coordinate using by your real robot collecting the noise data, this can help me better understand the transformation of your job.

Thanks a lot!

I got that the be below code is to turn the [ front = -z,left = -x, up=y] in habitat world frame to [front = x,left = y, o] in world frame[x,y,z]

     def get_sim_location(self):
        agent_state = super().habitat_env.sim.get_agent_state(0)

        x = -agent_state.position[2]
        y = -agent_state.position[0]
        axis = quaternion.as_euler_angles(agent_state.rotation)[0]
        if (axis%(2*np.pi)) < 0.1 or (axis%(2*np.pi)) > 2*np.pi - 0.1:
            o = quaternion.as_euler_angles(agent_state.rotation)[1]
        else:
            o = 2*np.pi - quaternion.as_euler_angles(agent_state.rotation)[1]
        if o > np.pi:
            o -= 2 * np.pi
        return x, y, o

and dx, dy, do = pu.get_rel_pose_change(curr_sim_pose, self.last_sim_location) is to get the relative in agent ego frame

But i am quite confused about the function get_new_pose

def get_new_pose(pose, rel_pose_change):
    x, y, o = pose
    dx, dy, do = rel_pose_change

    global_dx = dx * np.sin(np.deg2rad(o)) + dy * np.cos(np.deg2rad(o))
    global_dy = dx * np.cos(np.deg2rad(o)) - dy * np.sin(np.deg2rad(o))
    x += global_dy
    y += global_dx
    o += np.rad2deg(do)
    if o > 180.:
        o -= 360.

    return x, y, o

Why x+=global_dy and y+=global_dx? I know x,y is represented in full map frame.

What exactly the axis direction between all the frame you are using?
What is relation between the full_map frame full_map = torch.zeros(num_scenes, 4, full_w, full_h).float().to(device),(you use w as vertical, h as horizon, but we always use the h as vertical and w as horizon) and the agent frame(x, y, o)?

I am quite confused and stucked for a few days, please help me to understand it.
@devendrachaplot