/*
    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>

void chSysPause(void) {

  chThdSetPriority(IDLEPRIO);

  asm volatile (
  "ldi     r18, 1     \n\t"   // SE bit
  "out     0x33, r18  \n"     // SMCR
  );
  while (TRUE) {
    asm volatile ("sleep\n\t");
  }
}

void chSysHalt(void) {

  chSysLock();

  while (TRUE)
    ;
}