yop, c_trace works. It is exactly what i was looking for. And then i solved the block problem with normal modifier of c_trace. Thanks much everyone for help. I dont want to use cmove because it is something like school project and i am supposed to use just direct move. Project is focused on kinematic and dynamic movement.