Changed movement code to use a proper diagonal speed

Signed-off-by: BunnyRabbit2 <iamlewisstorey@yahoo.com>