Added undistort code for apriltags.cpp
Merge branch 'master' of https://github.com/magic-upenn/magic2010

Needed to add undistort code for images before publishing to IPC (apriltags.cpp)