Fixed error in system matrix assemblt