RMS function in VHDL