config.c 2.7 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697
  1. /*
  2. * Copyright (C) 2003-2005 by egnite Software GmbH. All rights reserved.
  3. *
  4. * Redistribution and use in source and binary forms, with or without
  5. * modification, are permitted provided that the following conditions
  6. * are met:
  7. *
  8. * 1. Redistributions of source code must retain the above copyright
  9. * notice, this list of conditions and the following disclaimer.
  10. * 2. Redistributions in binary form must reproduce the above copyright
  11. * notice, this list of conditions and the following disclaimer in the
  12. * documentation and/or other materials provided with the distribution.
  13. * 3. Neither the name of the copyright holders nor the names of
  14. * contributors may be used to endorse or promote products derived
  15. * from this software without specific prior written permission.
  16. *
  17. * THIS SOFTWARE IS PROVIDED BY EGNITE SOFTWARE GMBH AND CONTRIBUTORS
  18. * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  19. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  20. * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL EGNITE
  21. * SOFTWARE GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  22. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  23. * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
  24. * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
  25. * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  26. * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
  27. * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  28. * SUCH DAMAGE.
  29. *
  30. */
  31. /*
  32. * $Log$
  33. * Revision 1.1 2005/11/03 15:14:27 haraldkipp
  34. * First import.
  35. *
  36. */
  37. #include <avr/io.h>
  38. #include "config.h"
  39. #include "debug.h"
  40. CONFNET confnet = {
  41. 0,
  42. { 'E', 'T', 'H', 'E', 'R', 'N', 'U', 'T', 0 },
  43. { 0x00, 0x06, 0x98, 0x00, 0x00, 0x00 },
  44. 0, 0, 0, 0
  45. };
  46. CONFBOOT confboot;
  47. #ifdef EE_CONFNET
  48. static unsigned char ConfigGet(unsigned int loc)
  49. {
  50. while (EECR & 0x02);
  51. EEAR = loc;
  52. EECR |= 0x01;
  53. return EEDR;
  54. }
  55. static void ConfigRead(unsigned int loc, void *buf, size_t n)
  56. {
  57. unsigned char *cp = buf;
  58. while (n--) {
  59. *cp++ = ConfigGet(loc);
  60. loc++;
  61. }
  62. }
  63. #endif
  64. void BootConfigRead(void)
  65. {
  66. #ifdef EE_CONFNET
  67. DEBUG("CONFNET ");
  68. if (ConfigGet(EE_CONFNET) == sizeof(CONFNET)) {
  69. DEBUG("OK\n");
  70. ConfigRead(EE_CONFNET, &confnet, sizeof(CONFNET));
  71. #ifdef EE_CONFBOOT
  72. DEBUG("CONFBOOT ");
  73. if (ConfigGet(EE_CONFBOOT) == sizeof(CONFBOOT)) {
  74. DEBUG(" OK\n");
  75. ConfigRead(EE_CONFBOOT, &confboot, sizeof(CONFBOOT));
  76. }
  77. else {
  78. DEBUG("No\n");
  79. }
  80. #endif
  81. }
  82. else {
  83. DEBUG("No\n");
  84. }
  85. #endif
  86. }