Minor revision

+ Fixed Matrix origin bug
+ Fixed translation vector bug
+ Added utility function clamp()