Python add_noise Examples

Example #1

File: redux_test.py Project: shomberg/tangent-space-ukf

def measure_predict_ang(objs, noise, obj_indices, noise_indices):
    return add_noise([objs[obj_indices[0]].relative(objs[obj_indices[1]])], noise[noise_indices[0]:noise_indices[0]+1])[0]

Example #2

File: redux_test.py Project: shomberg/tangent-space-ukf

def measure_predict_vec(objs, noise, obj_indices, noise_indices):
    #pdb.set_trace()
    return add_noise([objs[obj_indices[0]].relative(objs[obj_indices[1]],[0,1,2]).relative(objs[obj_indices[2]], [0,1])], noise[noise_indices[0]:noise_indices[0]+3])[0]

Example #3

File: redux_test.py Project: shomberg/tangent-space-ukf

def state_update_move_vec(command, objs, noise, obj_indices, noise_indices):
    return add_noise([objs[obj_indices[0]]],noise[noise_indices[0]:noise_indices[0]+3]+matrix([[command*cos(objs[obj_indices[1]].toRadians()+pi/2)],[command*sin(objs[obj_indices[1]].toRadians()+pi/2)],[0]]))[0]

Example #4

File: redux_test.py Project: shomberg/tangent-space-ukf

def state_update_move_ang(command, objs, noise, obj_indices, noise_indices):
    return add_noise([Angle.fromRadians(objs[obj_indices[0]].toRadians()-pi/6*command)],noise[noise_indices[0]])[0]

Example #5

File: redux_test.py Project: shomberg/tangent-space-ukf

def state_update_none_ang(command, objs, noise, obj_indices, noise_indices):
    return add_noise([objs[obj_indices[0]]],noise[noise_indices[0]:noise_indices[0]+1])[0]