Teacher code

poppy_ros/poppy_ros.cpp

@@ -0,0 +1,25 @@
+void Callback(msg) {
+	//create empty vector
+	//fill it with msg
+	//call sendTargetJointPosition
+}
+
+int main(int argc, char** argv) {
+	ros::init(argc, argv, "poppy_ros");
+	ros::NodeHandle nh;
+	ros::Publisher pub = nh.advertise <msg>("joint_position", 1);
+	ros::Subscriber sub = nh.subscribe("joint_cmd", 1, Callback);
+	ros::Rate loopRate(10);
+	
+	while (ros::ok()) {
+		//create a msg
+		//call readCurrentJointPosition
+		//fill msg
+		//publish it
+		
+		ros::spinOnce();
+		loopRate.sleep();
+	}
+	
+	return 0;
+}

poppy_ros/src/poppy_ros.cpp

@@ -0,0 +1,25 @@
+void Callback(msg) {
+	//create empty vector
+	//fill it with msg
+	//call sendTargetJointPosition
+}
+
+int main(int argc, char** argv) {
+	ros::init(argc, argv, "poppy_ros");
+	ros::NodeHandle nh;
+	ros::Publisher pub = nh.advertise <msg>("joint_position", 1);
+	ros::Subscriber sub = nh.subscribe("joint_cmd", 1, Callback);
+	ros::Rate loopRate(10);
+	
+	while (ros::ok()) {
+		//create a msg
+		//call readCurrentJointPosition
+		//fill msg
+		//publish it
+		
+		ros::spinOnce();
+		loopRate.sleep();
+	}
+	
+	return 0;
+}