Added support for optionally enable the preview on the raspi display

I found it useful to have an option to enable the preview on the raspi display, so I implemented this with help of code from the raspivid application in raspbian.

In addition there are some code indentation fixes applied from a different fork, and some of my own.