arch/m68k-amiga/battclock/battclock_intern.c

   1 /*
   2     Copyright © 1995-2014, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 0
   7
   8 #include <aros/debug.h>
   9 #include <aros/libcall.h>
  10
  11 #include "battclock_intern.h"
  12
  13 UBYTE getreg(volatile UBYTE *p, UBYTE regnum)
  14 {
  15     return p[regnum * 4 + 3] & 15;
  16 }
  17 void putreg(volatile UBYTE *p, UBYTE regnum, UBYTE v)
  18 {
  19     p[regnum * 4 + 3] = v;
  20 }
  21 UBYTE getbcd(volatile UBYTE *p, UBYTE regnum)
  22 {
  23     return getreg(p, regnum + 1) * 10 + getreg(p, regnum);
  24 }
  25 void putbcd(volatile UBYTE *p, UBYTE regnum, UBYTE v)
  26 {
  27     putreg(p, regnum + 1, v / 10);
  28     putreg(p, regnum, v % 10);
  29 }
  30
  31 void stopclock(struct BattClockBase *Battclock)
  32 {
  33     volatile UBYTE *p = Battclock->clockptr;
  34     if (Battclock->clocktype == MSM6242B) {
  35         putreg(p, 0xf, 4 + 2);
  36     } else if (Battclock->clocktype == RF5C01A) {
  37         putreg(p, 0xd, 0);
  38     }
  39 }
  40 void startclock(struct BattClockBase *Battclock)
  41 {
  42     volatile UBYTE *p = Battclock->clockptr;
  43     if (Battclock->clocktype == MSM6242B) {
  44         putreg(p, 0xf, 4);
  45     } else if (Battclock->clocktype == RF5C01A) {
  46         putreg(p, 0xd, 8);
  47     }
  48 }
  49
  50 void resetbattclock(struct BattClockBase *Battclock)
  51 {
  52     volatile UBYTE *p = Battclock->clockptr;
  53     UBYTE i, j;
  54
  55     if (!p)
  56         return;
  57
  58     if (Battclock->clocktype == MSM6242B) {
  59         putreg(p, 0xd, 0);
  60         putreg(p, 0xe, 0);
  61         putreg(p, 0xf, 2);
  62         for (i = 0; i < 12; i++)
  63             putreg(p, i, 0);
  64         putreg(p, 0xf, 7); // reset
  65         putreg(p, 0xf, 4); // leave 24h on
  66     } else if (Battclock->clocktype == RF5C01A) {
  67         putreg(p, 0xd, 0); // stop
  68         putreg(p, 0xe, 0);
  69         for (j = 0; j < 4; j++) {
  70             putreg(p, 0xd, j);
  71             for (i = 0; i < 12; i++)
  72                 putreg(p, i, 0);
  73         }
  74         putreg(p, 0xd, 0);
  75         putreg(p, 0xf, 3); // reset
  76         putreg(p, 0xf, 0); // reset off
  77         putreg(p, 0xd, 8); // timer en
  78     }
  79 }