Final CC430 code used in demos