src/peripherals/avrdx-slpctrl.ts


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

// AVR-Dx SLPCTRL - Sleep Controller

import type { CPU } from 'avr8js/cpu/cpu';

const CTRLA = 0;
const SEN_bm    = 0x01;
const SMODE_gm  = 0x06;

export const SMODE_IDLE_gc = 0x00;
export const SMODE_STDBY_gc = 0x02;
export const SMODE_PDOWN_gc = 0x04;


export type SMODE = typeof SMODE_IDLE_gc | typeof SMODE_STDBY_gc | typeof SMODE_PDOWN_gc;
export type SleepCallback = (mode: SMODE) => void;

export class AVRDxSLPCTRL {
  sleepUntil: number = 0;
  sleeping: null | SMODE = null;
  callbacks: SleepCallback[];
  
  constructor(private cpu: CPU, private base: number) {
    // CTRLA - sleep mode + sleep enable
    cpu.writeHooks[base + CTRLA] = (value) => {
      cpu.data[base + CTRLA] = value;
      return true;
    };

    // Hook the SLEEP instruction
    cpu.onSleep = () => {
      this.handleSleep();
    };

    cpu.onBeforeInterrupt = () => {
      this.sleeping = null;
    };

    this.callbacks = [];
  }

  private handleSleep() {
    const ctrla = this.cpu.data[this.base + CTRLA];
    if (!(ctrla & SEN_bm)) return;

    const mode = ctrla & SMODE_gm;
    this.sleeping = mode as SMODE;

    const nextEvent = (this.cpu as any).nextClockEvent;
    if (nextEvent) {
      this.sleepUntil = nextEvent.cycles;
    }

    for (const cb of this.callbacks) {
      cb(mode as SMODE);
    }
  }

  onSleep(cb: SleepCallback) {
    this.callbacks.push(cb);
  }
}