avr/debugleds.c

   1 /*
   2  * Copyright (C) 2007 Anton Blad
   3  * Copyright (C) 2007 Fredrik Kuivinen
   4  * Copyright (C) 2007 Jakob Rosén
   5  *
   6  * This file is licensed under GPL v2.
   7  */
   8
   9 #include "debugleds.h"
  10
  11 #include "fcpu.h"
  12 #include <util/delay.h>
  13 #include <avr/io.h>
  14
  15 #if HWBOARD==DEVTRUT
  16 void debugled_init()
  17 {
  18         //DDRD |= 1;
  19 }
  20
  21 void debugled(uint8_t led, uint8_t state)
  22 {
  23         /*
  24         if(led == 0)
  25         {
  26                 switch(state)
  27                 {
  28                 case 0:
  29                         PORTD &= ~1;
  30                         break;
  31                 case 1:
  32                         PORTD |= 1;
  33                         break;
  34                 }
  35         }
  36         */
  37 }
  38
  39 void toggleled(uint8_t led)
  40 {
  41         /*
  42         if(led == 0)
  43         {
  44                 PIND = 1;
  45         }
  46         */
  47 }
  48
  49 void debugled4(uint8_t b)
  50 {
  51 }
  52
  53 void debugled8(uint8_t b)
  54 {
  55 }
  56
  57 void debugled8i(uint8_t b)
  58 {
  59 }
  60
  61 #else /* HWBOARD==DEVTRUT */
  62
  63 void debugled_init()
  64 {
  65         DDRD = 0xff;
  66 }
  67
  68 void debugled(uint8_t led, uint8_t state)
  69 {
  70         uint8_t val = (0x10 << led);
  71
  72         switch(state)
  73         {
  74         case 0:
  75                 PORTD &= ~val;
  76                 break;
  77         case 1:
  78                 PORTD |= val;
  79                 break;
  80         }
  81 }
  82
  83 void toggleled(uint8_t led)
  84 {
  85         uint8_t val = (0x10 << led);
  86
  87         PIND = val;
  88 }
  89
  90 void debugled4(uint8_t b)
  91 {
  92         PORTD = (PORTD & 0x0f) | (b << 4);
  93 }
  94
  95 void debugled8(uint8_t b)
  96 {
  97         debugled4(0x0f);
  98         _delay_ms(200);
  99         debugled4(b >> 4);
 100         _delay_ms(250);
 101         _delay_ms(250);
 102         _delay_ms(250);
 103         debugled4(b & 0x0f);
 104         _delay_ms(250);
 105         _delay_ms(250);
 106         _delay_ms(250);
 107         debugled4(0);
 108         _delay_ms(250);
 109         _delay_ms(250);
 110 }
 111
 112 void debugled8i(uint8_t b)
 113 {
 114         debugled4(0x0f);
 115         _delay_ms(200);
 116         debugled4(b >> 4);
 117         while(PINE & (1 << PINE2));
 118         debugled4(b & 0xff);
 119         while(!(PINE & (1 << PINE2)));
 120         while(PINE & (1 << PINE2));
 121         debugled4(0);
 122         while(!(PINE & (1 << PINE2)));
 123 }
 124 #endif /* HWBOARD==DEVTRUT */