Add the feature to the ros2_control interface generation

[solid-sinusoid]

I propose to add specifications to support the ros2_control interface generation, like in demos, and maybe add template generation for writing the cpp file for the custom interface or add existing