Added motor controller node, still need to create and publish messages