Finished the arm_camera_node.cpp and arm_control_node.cpp
The code can be seen here: https://github.com/RX-00/Fetch
Some problems with the code itself is that the transmission and actual movement of the sevos are rather slow probably due to sending info from the cpp program to the arduino over serial. However, this is not a critical problem as fetch just needs to know how close the target object is based on the camera and distance sensor to know when to grab the target object.
Next steps are to work on are:
-creating ultra_sonic_distance_node.cpp
-getting SLAM to work
-fixing the motors & finish the electronics
-work on the kinect sensor adaption
Here's a pic of the camera code in action, this one is a bit older than this update so now the noise is even more cleaned up!
