added test publisher
add twist controller launch file
use twist controller for cob4-1 torso