Switched bus master code to mainline because XC8 cannot figure out
that it won't be called reentrantly and I can't force it to not
duplicate all the code :(.