Code for Javad to use on the Waverly Place Waspmote.