Wave position

[danhaus]

• Debugging
• Moving wave_position settings to parameter file default.yaml
• Improving initialisation so that it depends on number of items in a queue rather than time
• Reducing order of model function, model_func, and adding bounds to curve_fit to improve performance

[tsaoyu]

Please resolve conflicts first. Thanks

[tsaoyu]

Once we done some tests on this, you can delete the branch.