Fixed the origin shifting problem and added round2.m file

I've fixed the origin shifting problem and at the same time. One thing I
noticed during scaling function calculation or rotation calculation is
that MATLAB takes a lot of liberties in performing approximations. Thus,
made approximations a little bit stricter for rotation and scaling.