You might want to check out ROS from the willow garage people. It's probably the right tool that you're looking for.