Change Makefile to work on my Laptop
ARAP: Implement cost function evaluation
ARAP: Fix fitting code