123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129 |
- #ifndef BOOTFIRMWARE2_SOURCE
- #define BOOTFIRMWARE2_SOURCE
- #include <stdint.h>
- #include <unistd.h>
- #include <memory.h>
- #include <errno.h>
- #include "../tools/files.h"
- #include "../tools/error.h"
- #include "../tools/flags.h"
- #include "../plc/plc.h"
- #include "../nvm/nvm.h"
- signed BootFirmware2 (struct plc * plc)
- {
- unsigned module = 0;
- struct nvm_header2 nvm_header;
- if (lseek (plc->NVM.file, 0, SEEK_SET))
- {
- error (1, errno, FILE_CANTHOME, plc->NVM.name);
- }
- do
- {
- if (read (plc->NVM.file, &nvm_header, sizeof (nvm_header)) != sizeof (nvm_header))
- {
- error (1, errno, NVM_HDR_CANTREAD, plc->NVM.name, module);
- }
- if (LE16TOH (nvm_header.MajorVersion) != 1)
- {
- error (1, ECANCELED, NVM_HDR_VERSION, plc->NVM.name, module);
- }
- if (LE16TOH (nvm_header.MinorVersion) != 1)
- {
- error (1, ECANCELED, NVM_HDR_VERSION, plc->NVM.name, module);
- }
- if (checksum32 (&nvm_header, sizeof (nvm_header), 0))
- {
- error (1, ECANCELED, NVM_HDR_CHECKSUM, plc->NVM.name, module);
- }
- #if 0
- if (_allclr (LE16TOH (nvm_header.ExecuteMask), (1 << (plc->hardwareID - 1))))
- {
- if (lseek (plc->NVM.file, LE32TOH (nvm_header.NextHeader), SEEK_SET) == -1)
- {
- error (1, errno, "Can't skip module: %s (%d)", plc->NVM.name, module);
- }
- }
- else
- #endif
- if (LE32TOH (nvm_header.ImageType) == NVM_IMAGE_FIRMWARE)
- {
- if (WriteExecuteFirmware2 (plc, module, &nvm_header))
- {
- return (-1);
- }
- break;
- }
- if (lseek (plc->NVM.file, LE32TOH (nvm_header.NextHeader), SEEK_SET) == -1)
- {
- error (1, errno, "Can't skip module: %s (%d)", plc->NVM.name, module);
- }
- module++;
- }
- while (~nvm_header.NextHeader);
- return (0);
- }
- #endif
|