Add util test program
Add basic matrix routines to util

These routines are intended to be used during initialization.  They are
not not intended to be used during a simulation.
Teach dictionary to count the number of entries