alex/rp-hal-boards
1
0
Fork 0
mirror of https://github.com/italicsjenga/rp-hal-boards.git synced 2024-12-23 12:41:31 +11:00
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #453 from jannic/update-jmp-offset

Browse source 
simplify jump offset calculation when loading PIO programs
This commit is contained in:
Jan Niehusmann 2022-09-27 22:25:22 +02:00 committed by GitHub
parent 4f440d286d 6a5747b213
commit 8d9b4538c9
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
1 changed files with 11 additions and 19 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

30
rp2040-hal/src/pio.rs
View file

@ -156,7 +156,7 @@ impl<P: PIOExt> PIO<P> {
}
/// Tries to find an appropriate offset for the instructions, in range 0..=31.
fn find_offset_for_instructions(&self, i: &[u16], origin: Option<u8>) -> Option<usize> {
fn find_offset_for_instructions(&self, i: &[u16], origin: Option<u8>) -> Option<u8> {
if i.len() > PIO_INSTRUCTION_COUNT || i.is_empty() {
None
} else {
@ -167,10 +167,10 @@ impl<P: PIOExt> PIO<P> {
{
None
} else {
Some(origin as usize)
Some(origin)
}
} else {
for i in (0..=32 - i.len()).rev() {
for i in (0..=32 - (i.len() as u8)).rev() {
if self.used_instruction_space & (mask << i) == 0 {
return Some(i);
}
@ -195,32 +195,24 @@ impl<P: PIOExt> PIO<P> {
.iter()
.cloned()
.map(|instr| {
if let Some(Instruction {
operands: InstructionOperands::JMP { condition, address },
delay,
side_set,
}) = Instruction::decode(instr, p.side_set)
{
// JMP instruction. We need to apply offset here
let address = address + offset as u8;
if instr & 0b1110_0000_0000_0000 == 0 {
// this is a JMP instruction -> add offset to address
let address = (instr & 0b11111) as u8;
let address = address + offset;
assert!(
address < pio::RP2040_MAX_PROGRAM_SIZE as u8,
"Invalid JMP out of the program after offset addition"
);
Instruction {
operands: InstructionOperands::JMP { condition, address },
delay,
side_set,
}
.encode(p.side_set)
instr & (!0b11111) | address as u16
} else {
// this is not a JMP instruction -> keep it unchanged
instr
}
})
.enumerate()
.for_each(|(i, instr)| {
self.pio.instr_mem[i + offset].write(|w| unsafe { w.instr_mem0().bits(instr) })
self.pio.instr_mem[i + offset as usize]
.write(|w| unsafe { w.instr_mem0().bits(instr) })
});
self.used_instruction_space |= Self::instruction_mask(p.code.len()) << offset;
Ok(InstalledProgram {