Le uniche cose che devi cambiare sono le allocazioni dinamiche delle matrici (e il private davanti al nome del metodo).
Per il resto e' pressoche' tutto uguale.