Initial implementation of discovery mode

Arduino responds to the requests of discovery mode. Only tested with
single client - not with several clients.