Added AngleController and FixAngle