#36 Camera matrix calculations

Fixes #36 - Camera matrix is calculated correctly. Helper methods added
to Entity for position and rotation interpolation between frames.