Added servo stuff and changed some gui
fixing