First version

Done Features:
Force and angle set
Rotation
Distance calculating