First Version of Matrix4

Took some things from old code...much of these still needs to be
optimized and/or checked for errors...but it seems that they should work
for now.