levitating pendulum working

now correctly simulates magnet rotation and control algorithm correctly
tracks at targetdist…