Update dyno_control.ino

completed calcSpeed method