Initial checkin

More or less working with test hardware