PLL implementation extended to harmonic signals. Module utilities.py
added to construct block diagonal matrices that are required to
simulatea superposition of several sinusoids with different frequency.