Embedded System (Firmware) for SmartAnthill Project