Add matrix.h. Matrix implementation for bones.