Rework internal structure of `magnetforces.m`

Currently there is too much branching within a larger, bigger, messier, main function. It would be far cleaner to remove the multiple branches based on geometry (things like `
if strcmp(magtype,'cuboid')`) and write more structured nested code.