aboutsummaryrefslogtreecommitdiffstats
path: root/demos/AVR-AT90CANx-GCC/chcore.c
blob: 9d2e0e1b2974bbad0b7e62c5ec8b069409cc41ae (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
/*
    ChibiOS/RT - Copyright (C) 2006-2007 Giovanni Di Sirio.

    This file is part of ChibiOS/RT.

    ChibiOS/RT is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 3 of the License, or
    (at your option) any later version.

    ChibiOS/RT is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/

#include <ch.h>

#include <avr/io.h>

void hwinit(void) {

  /*
   * I/O ports setup.
   * Everything configured as input with pull-up initially.
   */
  DDRA  = 0;
  PORTA = 0xFF;
  DDRB  = 0;
  PORTB = 0xFF;
  DDRC  = 0;
  PORTC = 0xFF;
  DDRD  = 0;
  PORTD = 0xFF;
  DDRE  = 0;
  PORTE = 0xFF;
  DDRF  = 0;
  PORTF = 0xFF;
  DDRG  = 0;
  PORTG = 0xFF;

  /*
   * Enables Idle mode for SLEEP instruction.
   */
  SMCR = 1;
}

void chSysPause(void) {

  chThdSetPriority(IDLEPRIO);

  while (TRUE) {
//    asm volatile ("sleep");
  }
}

void chSysHalt(void) {

  chSysLock();

  while (TRUE)
    ;
}