Finalized angular coordination algorithm, added some comments, removed unused variable