Function cmd_measure_speed

FluxEngine.cydsn/main.c:304–336

}
    
static void cmd_measure_speed(struct measurespeed_frame* f)
{
    start_motor();
    
    index_irq = false;
    int start_clock = clock;
    int elapsed = 0;
    while (!index_irq)
    {
        elapsed = clock - start_clock;
        if (elapsed > 1500)
        {
            elapsed = 0;
            break;
        }
    }

    if (elapsed != 0)
    {
        int target_pulse_count = f->hard_sector_count + 1;
        start_clock = clock;
        for (int x=0; x<target_pulse_count; x++)
        {
            index_irq = false;
            while (!index_irq)
                elapsed = clock - start_clock;
        }
    }
    
    DECLARE_REPLY_FRAME(struct speed_frame, F_FRAME_MEASURE_SPEED_REPLY);
    r.period_ms = elapsed;
    send_reply((struct any_frame*) &r);    
}

static void cmd_bulk_write_test(struct any_frame* f)
{