int XZ_Foot::init() { speed_mm = 0; speed_pulse = 0; regist_gpio(dir_connector_0, dir_pin_0, DIR_OUT); regist_gpio(dir_connector_1, dir_pin_1, DIR_OUT); regist_gpio(pwm_connector, pwm_pin, DIR_IN); }
void servo_regist() { regist_gpio(servo_pin[0][0], servo_pin[0][1], DIR_OUT); regist_gpio(servo_pin[1][0], servo_pin[1][1], DIR_OUT); }