Use affine transformations for low-level movement logic

Use affine transformations for low-level movement logic #478