Firmware

Added firmware for radios, still not working still need to dig more.