Firmware updates

Added delay timing functionality
Started hashing out radio command/control