Hyaguchijsk/add servo controller

I've tested with hiro014.