Added remaining Dstick functions, changed Dstick jaguars into servos