switch angle solver to bisection method

[Alexanderallenbrown]

At your convenience, borrow the bisection code from Dallis's branch High-Pass-Filter-Creation and add to your platform position code, instead of using fminsearch. This will prevent us from requesting motor angles outside of the range (0, pi/2)

[megantuttle]

fixed with commit 28dc1d1