Update some docs and added demo for control servo