Better way of skipping command interfaces in joint_state_controller

[bmagyar]

We could discuss the logic here. Maybe there is another way to do this, without so much looping... (but let's leave it for the future)

Originally posted by @destogl in https://github.com/ros-controls/ros2_controllers/pull/90#discussion_r486626815