Fixed accuracy problem. from accumulated error +1cm to 0.05mm
Complete Step Left and Right function.

Signed-off-by: Lee Chee Cheong <ccheonglee@gmail.com>