added ground and translation/rotation matrix math