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