Added Trace and ability to construct diagonal matrices from vectors