use ch32rv_contract::Warning;
use ch32rv_wchlink::Speed;
pub fn speed(s: &str) -> Result<(Speed, Vec<Warning>), String> {
let mut warnings = Vec::new();
let speed = match s {
"low" => Speed::Low,
"medium" => Speed::Medium,
"high" => Speed::High,
other => {
let khz: u32 = other
.parse()
.map_err(|_| format!("invalid --speed `{other}` (low|medium|high|<kHz>)"))?;
let (speed, actual) = if khz >= 6000 {
(Speed::High, 6000)
} else if khz >= 4000 {
(Speed::Medium, 4000)
} else if khz >= 400 {
(Speed::Low, 400)
} else {
return Err(format!(
"--speed {khz} kHz is below the minimum step (400 kHz)"
));
};
if actual != khz {
warnings.push(Warning {
code: "speed-rounded".to_owned(),
msg: format!("requested {khz} kHz rounded to the {actual} kHz step"),
});
}
speed
}
};
Ok((speed, warnings))
}
pub fn u32_addr(s: &str) -> Result<u32, String> {
let t = s.trim();
let v = if let Some(hex) = t.strip_prefix("0x").or_else(|| t.strip_prefix("0X")) {
u32::from_str_radix(hex, 16)
} else {
t.parse::<u32>()
};
v.map_err(|_| format!("invalid address/number `{s}` (use 0x-hex or decimal)"))
}
pub fn byte_len(s: &str) -> Result<u32, String> {
let t = s.trim().to_ascii_lowercase();
let (num, mult) = if let Some(n) = t.strip_suffix('k') {
(n, 1024)
} else if let Some(n) = t.strip_suffix('m') {
(n, 1024 * 1024)
} else {
(t.as_str(), 1)
};
let base = u32_addr(num)?;
base.checked_mul(mult)
.ok_or_else(|| format!("length `{s}` overflows u32"))
}
pub fn range(s: &str) -> Result<(u32, u32), String> {
if let Some((a, l)) = s.split_once('+') {
let start = u32_addr(a)?;
let len = byte_len(l)?;
Ok((start, len))
} else if let Some((a, b)) = s.split_once("..") {
let start = u32_addr(a)?;
let end = u32_addr(b)?;
if end < start {
return Err(format!("range end {end:#x} is before start {start:#x}"));
}
Ok((start, end - start))
} else {
Err(format!(
"invalid range `{s}` (use <addr>+<len> or <addr>..<end>)"
))
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn speed_named_and_rounded() {
assert!(matches!(speed("low"), Ok((Speed::Low, w)) if w.is_empty()));
assert!(matches!(speed("medium"), Ok((Speed::Medium, w)) if w.is_empty()));
assert!(matches!(speed("high"), Ok((Speed::High, w)) if w.is_empty()));
assert!(matches!(speed("6000"), Ok((Speed::High, w)) if w.is_empty()));
assert!(matches!(speed("4000"), Ok((Speed::Medium, w)) if w.is_empty()));
assert!(matches!(speed("400"), Ok((Speed::Low, w)) if w.is_empty()));
assert!(matches!(speed("5000"), Ok((Speed::Medium, w)) if w.len() == 1));
assert!(matches!(speed("9000"), Ok((Speed::High, w)) if w.len() == 1));
assert!(speed("399").is_err());
assert!(speed("fast").is_err());
}
#[test]
fn u32_hex_and_decimal() {
assert_eq!(
u32_addr("0x0800_0000".replace('_', "").as_str()),
Ok(0x0800_0000)
);
assert_eq!(u32_addr("0X10"), Ok(0x10));
assert_eq!(u32_addr("4096"), Ok(4096));
assert_eq!(u32_addr(" 0x20 "), Ok(0x20)); assert!(u32_addr("nope").is_err());
assert!(u32_addr("0xZZ").is_err());
}
#[test]
fn byte_len_suffixes() {
assert_eq!(byte_len("256"), Ok(256));
assert_eq!(byte_len("4k"), Ok(4096));
assert_eq!(byte_len("1m"), Ok(1024 * 1024));
assert_eq!(byte_len("0x100"), Ok(256));
assert_eq!(byte_len("2K"), Ok(2048)); assert!(byte_len("5m").is_ok());
assert!(byte_len("0xffffffffk").is_err()); }
#[test]
fn range_plus_and_dotdot() {
assert_eq!(range("0x0+16"), Ok((0, 16)));
assert_eq!(range("0x1000+4k"), Ok((0x1000, 4096)));
assert_eq!(range("0x10..0x20"), Ok((0x10, 0x10)));
assert_eq!(range("0x08000000..0x08000100"), Ok((0x0800_0000, 0x100)));
assert!(range("0x20..0x10").is_err());
assert!(range("0x100").is_err());
}
}