encode_rs.c 1.3 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455
  1. /*
  2. * lib/reed_solomon/encode_rs.c
  3. *
  4. * Overview:
  5. * Generic Reed Solomon encoder / decoder library
  6. *
  7. * Copyright 2002, Phil Karn, KA9Q
  8. * May be used under the terms of the GNU General Public License (GPL)
  9. *
  10. * Adaption to the kernel by Thomas Gleixner (tglx@linutronix.de)
  11. *
  12. * $Id: encode_rs.c,v 1.5 2005/11/07 11:14:59 gleixner Exp $
  13. *
  14. */
  15. /* Generic data width independent code which is included by the
  16. * wrappers.
  17. * int encode_rsX (struct rs_control *rs, uintX_t *data, int len, uintY_t *par)
  18. */
  19. {
  20. int i, j, pad;
  21. int nn = rs->nn;
  22. int nroots = rs->nroots;
  23. uint16_t *alpha_to = rs->alpha_to;
  24. uint16_t *index_of = rs->index_of;
  25. uint16_t *genpoly = rs->genpoly;
  26. uint16_t fb;
  27. uint16_t msk = (uint16_t) rs->nn;
  28. /* Check length parameter for validity */
  29. pad = nn - nroots - len;
  30. if (pad < 0 || pad >= nn)
  31. return -ERANGE;
  32. for (i = 0; i < len; i++) {
  33. fb = index_of[((((uint16_t) data[i])^invmsk) & msk) ^ par[0]];
  34. /* feedback term is non-zero */
  35. if (fb != nn) {
  36. for (j = 1; j < nroots; j++) {
  37. par[j] ^= alpha_to[rs_modnn(rs, fb +
  38. genpoly[nroots - j])];
  39. }
  40. }
  41. /* Shift */
  42. memmove(&par[0], &par[1], sizeof(uint16_t) * (nroots - 1));
  43. if (fb != nn) {
  44. par[nroots - 1] = alpha_to[rs_modnn(rs,
  45. fb + genpoly[0])];
  46. } else {
  47. par[nroots - 1] = 0;
  48. }
  49. }
  50. return 0;
  51. }