linux-imx
Public
Source
committed 9f757f41521x
/* * Copyright (C) 2012 CERN (www.cern.ch) * Author: Alessandro Rubini <rubini@gnudd.com> * * Released according to the GNU GPL, version 2 or any later version. * * This work is part of the White Rabbit project, a research effort led * by CERN, the European Institute for Nuclear Research. *//* * This module uses the firmware loader to program the whole or part * of the FMC eeprom. The meat is in the _run functions. However, no * default file name is provided, to avoid accidental mishaps. Also, * you must pass the busid argument */static struct fmc_driver fwe_drv;FMC_PARAM_BUSID(fwe_drv);/* The "file=" is like the generic "gateware=" used elsewhere */static char *fwe_file[FMC_MAX_CARDS];static int fwe_file_n;module_param_array_named(file, fwe_file, charp, &fwe_file_n, 0444);static int fwe_run_tlv(struct fmc_device *fmc, const struct firmware *fw, int write){ const uint8_t *p = fw->data; int len = fw->size; uint16_t thislen, thisaddr; int err; /* format is: 'w' addr16 len16 data... */ while (len > 5) { thisaddr = get_unaligned_le16(p+1); thislen = get_unaligned_le16(p+3); if (p[0] != 'w' || thislen + 5 > len) { dev_err(&fmc->dev, "invalid tlv at offset %ti\n", p - fw->data); return -EINVAL; } err = 0; if (write) { dev_info(&fmc->dev, "write %i bytes at 0x%04x\n", thislen, thisaddr); err = fmc_write_ee(fmc, thisaddr, p + 5, thislen); } if (err < 0) { dev_err(&fmc->dev, "write failure @0x%04x\n", thisaddr); return err; } p += 5 + thislen; len -= 5 + thislen; } if (write) dev_info(&fmc->dev, "write_eeprom: success\n"); return 0;}static int fwe_run_bin(struct fmc_device *fmc, const struct firmware *fw){ int ret; dev_info(&fmc->dev, "programming %zi bytes\n", fw->size); ret = fmc_write_ee(fmc, 0, (void *)fw->data, fw->size); if (ret < 0) { dev_info(&fmc->dev, "write_eeprom: error %i\n", ret); return ret; } dev_info(&fmc->dev, "write_eeprom: success\n"); return 0;}static int fwe_run(struct fmc_device *fmc, const struct firmware *fw, char *s){ char *last4 = s + strlen(s) - 4; int err; if (!strcmp(last4, ".bin")) return fwe_run_bin(fmc, fw); if (!strcmp(last4, ".tlv")) { err = fwe_run_tlv(fmc, fw, 0); if (!err) err = fwe_run_tlv(fmc, fw, 1);