Added Firmware Pseudocode