Refactor servo config

Signed-off-by: Maslov Nikita <wkernelteam@gmail.ru>