Fix lens distortion

Signed-off-by: Claudio Matsuoka <cmatsuoka@gmail.com>