module sim

const worker_test_mock_params = SimParams{
    rope_length:     0.25
    bearing_mass:    0.03
    magnet_spacing:  0.05
    magnet_height:   0.03
    magnet_strength: 10
    gravity:         4.9
}
const worker_test_mock_state = SimState{
    position: vector(
        x: -0.016957230930171364
        y: -0.02937078552673521
        z: 0.002311063475327252
    )
    velocity: vector(
        x: -7.251158929833104
        y: -12.559375680227724
        z: -105.91539687686381
    )
    accel:    vector(
        x: -8.337034766251843e-11
        y: -2.842170943040401e-10
        z: 1.2126596023639044e-10
    )
}

fn test_compute_result() {
    request := SimRequest{
        id:     0
        params: worker_test_mock_params
        state:  worker_test_mock_state
    }
    expected_state := SimState{
        position: vector(
            x: -0.01695723093017135
            y: -0.029370785526735183
            z: 0.002311063475327252
        )
        velocity: vector(
            x: -7.251158929831753
            y: -12.55937568022536
            z: -105.91539687684447
        )
        accel:    vector(
            x: -1.1368683772161603e-11
            y: -1.5916157281026244e-10
            z: 0
        )
    }
    expected := &SimResult{
        state:            expected_state
        id:               0
        magnet1_distance: 0.07993696666249225
        magnet2_distance: 0.07993696666249224
        magnet3_distance: 0.03609361938278008
    }
    result := compute_result(request)
    assert result == expected
}