robot.py: switch setFootXY to interpolated movements

Signed-off-by: Koen Kooi <koen@dominion.thruhere.net>