added publish of robot position and jointstate