Added early work on an offline forward kinematics server for hubo using KDL and Willow's robot state publisher as a basis