Moved code to firmware sub-directory