Refactor a bit
Add Linux servo config.