refactoring
fixed bug
added experiment with 3-dim angle