fully tested, tuning of large angle controller not yet acceptable