Actaul contiki code, though not tested