Autonomous Systems Laboratory Department Of Mechanical Engineering State University Of New York At Stony Brook