Newer
Older
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
67
68
69
70
71
72
73
74
75
76
77
78
79
pub struct Pad {
down: bool,
up: bool,
left: bool,
right: bool,
start: bool,
select: bool,
b: bool,
a: bool,
selection: PadSelection,
}
#[derive(Clone, Copy, PartialEq)]
pub enum PadSelection {
Action,
Direction,
}
impl Pad {
pub fn new() -> Self {
Self {
down: false,
up: false,
left: false,
right: false,
start: false,
select: false,
b: false,
a: false,
selection: PadSelection::Action,
}
}
pub fn read(&mut self, addr: u16) -> u8 {
match addr & 0x00ff {
0x0000 => {
let mut value;
match self.selection {
PadSelection::Action => {
value = if self.a { 0x01 } else { 0x00 }
| if self.b { 0x02 } else { 0x00 }
| if self.select { 0x04 } else { 0x00 }
| if self.start { 0x08 } else { 0x00 }
}
PadSelection::Direction => {
value = if self.right { 0x01 } else { 0x00 }
| if self.left { 0x02 } else { 0x00 }
| if self.up { 0x04 } else { 0x00 }
| if self.down { 0x08 } else { 0x00 }
}
}
value |= if self.selection == PadSelection::Direction {
0x00
} else {
0x10
} | if self.selection == PadSelection::Action {
0x00
} else {
0x20
};
value
}
addr => panic!("Reading from unknown Pad location 0x{:04x}", addr),
}
}
pub fn write(&mut self, addr: u16, value: u8) {
match addr & 0x00ff {
0x0000 => {
self.selection = if value & 0x10 == 0x00 {
PadSelection::Direction
} else {
PadSelection::Action
}
}
addr => panic!("Reading from unknown Pad location 0x{:04x}", addr),
}
}
}