Movement is complete

I finsihed movement and added a AP calculation