Working code for Turtle Sense