First working firmware!