code from our LEGO subject - Embedded Systems