Fixed some problems in HeadControlTask