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
}