Edited constants. Fixed initial theta angle.