Added 2 servo interfaces, many optimizations