def display(self, color=None): # import here to avoid circular dependency import mrol_mapping.visualiser.dispxyz as dispxyz return dispxyz.showpts(self.points, pose=self.pose, color=color)
def depth_filt_min_non_zero(p1, p2): if p1 == 0 or p2 == 0: return if p1 > p2: p1 = 0 return if p2 > p1: p2 = 0 return return def depth_disconts2(di, tol=0.2): import pydb pydb.set_trace() import scipy.ndimage as ndimage ndimage.gaussian_filter(di, sigma=(5, 5)) ndimage.gaussian_derivative() ndimage.median_filter() return di_diff if __name__ == '__main__': fname = sys.argv[1] xyzs = image_to_points(fname) import mrol_mapping.visualiser.dispxyz as dispxyz dispxyz.showpts(xyzs) print 'Escape to close window'