controller: implement servo parameter application
controller: implement servo parameter application

Apply parameters to servo.

Change-Id: Icd79097e2a28fdb9c648d518edac4602e0cd9ae6

open-rnd/ros3d-dev-controller