Research work done for Rensselaer Polytechnic Institute's CS Robotics Lab