Cleaned up a little bit and integrated some of the changes from one of the robots. Fixed arduino program to current working version.
Added other packages created on robot.
Added whole ros_lib library required by arduino program.