added epsilon term when evaluating constraints, and added initial angle function