cleaned up Tests.scd
update on wander behavior (still not functional)
changed the wander behavior to be instance based
added defaults for heading and side
created matrix transform class. For steering.