scara-calculation morecomplete and corrected

I forgot to calculate the required delta-angles, but only calculated the
steps from bed-zero to pos_x/y.
Now we get the delta-angles (and steps) to reach pos + distance.
Still working on update_current_position and calibration

+little correction on home.c (because of compiler warning)