Program interface changed and some physics are implemented. Angle calculation bug