Added first version of Tests

Added boilerplate code for tests, and fixed delay value (200 milliseconds
instead of seconds...)