got looping of servo angles working, as well as measurement collection