Add (non-functional) filter wheel controls
First working filter wheel integration
Code tidy