fixed bugs, imporved gui feedback of controller state, ready for testing servo control