Fuerte version, forked from wu-robotics SVN repo