improvements on matrix4, fixed camera