Library is ready for some tests

Library prepared to be tested on the demo-board