robot.py: convert setFootY to interpolated movements

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