Rewritten "speed"-function

Z axis works now! Animation is still missing…