Rework internal structure of `magnetforces.m`

[wspr]

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.