sdmmc_core/command/class/class9/cmd39/
arg.rs1use crate::lib_bitfield;
2use crate::result::{Error, Result};
3
4lib_bitfield! {
5 pub Argument(u32): u16 {
7 raw_rca: 31, 16;
8 pub register_write_flag: 15;
10 raw_register_address: 14, 8;
11 raw_register_data: 7, 0;
12 }
13}
14
15impl Argument {
16 pub const LEN: usize = 4;
18 pub const DEFAULT: u32 = 0;
20
21 pub const fn new() -> Self {
23 Self(Self::DEFAULT)
24 }
25
26 pub const fn rca(&self) -> u16 {
28 self.raw_rca()
29 }
30
31 pub fn set_rca(&mut self, val: u16) {
33 self.set_raw_rca(val as u32);
34 }
35
36 pub const fn register_address(&self) -> u8 {
38 self.raw_register_address() as u8
39 }
40
41 pub fn set_register_address(&mut self, val: u8) {
43 self.set_raw_register_address(val as u32);
44 }
45
46 pub const fn register_data(&self) -> u8 {
48 self.raw_register_data() as u8
49 }
50
51 pub fn set_register_data(&mut self, val: u8) {
53 self.set_raw_register_data(val as u32);
54 }
55
56 pub const fn from_bits(val: u32) -> Self {
58 Self(val)
59 }
60
61 pub const fn try_from_bits(val: u32) -> Result<Self> {
63 Ok(Self::from_bits(val))
64 }
65
66 pub const fn bytes(&self) -> [u8; Self::LEN] {
68 self.0.to_be_bytes()
69 }
70
71 pub const fn try_from_bytes(val: &[u8]) -> Result<Self> {
73 match val.len() {
74 len if len < Self::LEN => Err(Error::invalid_length(len, Self::LEN)),
75 _ => Self::try_from_bits(u32::from_be_bytes([val[0], val[1], val[2], val[3]])),
76 }
77 }
78}
79
80impl Default for Argument {
81 fn default() -> Self {
82 Self::new()
83 }
84}
85
86impl From<Argument> for u32 {
87 fn from(val: Argument) -> Self {
88 val.bits()
89 }
90}
91
92impl From<Argument> for [u8; Argument::LEN] {
93 fn from(val: Argument) -> Self {
94 val.bytes()
95 }
96}
97
98impl TryFrom<u32> for Argument {
99 type Error = Error;
100
101 fn try_from(val: u32) -> Result<Self> {
102 Self::try_from_bits(val)
103 }
104}
105
106impl TryFrom<&[u8]> for Argument {
107 type Error = Error;
108
109 fn try_from(val: &[u8]) -> Result<Self> {
110 Self::try_from_bytes(val)
111 }
112}
113
114impl<const N: usize> TryFrom<&[u8; N]> for Argument {
115 type Error = Error;
116
117 fn try_from(val: &[u8; N]) -> Result<Self> {
118 Self::try_from_bytes(val.as_ref())
119 }
120}
121
122impl<const N: usize> TryFrom<[u8; N]> for Argument {
123 type Error = Error;
124
125 fn try_from(val: [u8; N]) -> Result<Self> {
126 Self::try_from_bytes(val.as_ref())
127 }
128}
129
130#[cfg(test)]
131mod tests {
132 use super::*;
133
134 #[test]
135 fn test_fields() {
136 (1..=u32::BITS)
137 .map(|r| ((1u64 << r) - 1) as u32)
138 .for_each(|raw_arg| {
139 let raw = raw_arg.to_be_bytes();
140 let mut exp_arg = Argument(raw_arg);
141
142 let exp_rca = (raw_arg >> 16) as u16;
143 let exp_write_flag = (raw_arg & (1 << 15)) != 0;
144 let exp_addr = ((raw_arg & 0x7f00) >> 8) as u8;
145 let exp_data = (raw_arg & 0xff) as u8;
146
147 assert_eq!(Argument::try_from_bits(raw_arg), Ok(exp_arg));
148 assert_eq!(Argument::try_from_bytes(raw.as_ref()), Ok(exp_arg));
149 assert_eq!(Argument::try_from(raw_arg), Ok(exp_arg));
150 assert_eq!(Argument::try_from(raw), Ok(exp_arg));
151 assert_eq!(Argument::try_from(&raw), Ok(exp_arg));
152
153 assert_eq!(exp_arg.bits(), raw_arg);
154 assert_eq!(exp_arg.bytes(), raw);
155
156 assert_eq!(exp_arg.rca(), exp_rca);
157
158 exp_arg.set_rca(0);
159 assert_eq!(exp_arg.rca(), 0);
160
161 exp_arg.set_rca(exp_rca);
162 assert_eq!(exp_arg.rca(), exp_rca);
163
164 assert_eq!(exp_arg.register_write_flag(), exp_write_flag);
165
166 test_field!(exp_arg, register_write_flag: 15);
167
168 assert_eq!(exp_arg.register_address(), exp_addr);
169
170 exp_arg.set_register_address(0);
171 assert_eq!(exp_arg.register_address(), 0);
172
173 exp_arg.set_register_address(exp_addr);
174 assert_eq!(exp_arg.register_address(), exp_addr);
175
176 assert_eq!(exp_arg.register_data(), exp_data);
177
178 exp_arg.set_register_data(0);
179 assert_eq!(exp_arg.register_data(), 0);
180
181 exp_arg.set_register_data(exp_data);
182 assert_eq!(exp_arg.register_data(), exp_data);
183 });
184 }
185}