change to effort controller and adapt its parameters accordingly
add joint state controller