Testing_Firmware

All code for static fires and tests

After running main make sure to delete any pycache files that appear, it messes with commits and merging occasionally