Code from Robotics course at Stony Brook