Skip to content

Instantly share code, notes, and snippets.

@eufat
Created August 6, 2016 13:58
Show Gist options
  • Save eufat/5cd29eeff0fb2d6c2026d2ccb727f9bc to your computer and use it in GitHub Desktop.
Save eufat/5cd29eeff0fb2d6c2026d2ccb727f9bc to your computer and use it in GitHub Desktop.
float set_speed(float omega_input){
float omega_read_encoder = read_encoder_speed();
if (omega_input != omega_read_encoder){
if (omega_read_encoder > omega_input) mv++;
if (omega_read_encoder < omega_input) mv--;
}
motor_drive(mv)
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment