First working version

Movement and capture implemented.
TODO: autofocus, complete error handling.