Add stride argument to matrixSetValues

Dries up creating identitiy matrices