About to implement large change
Added repulsion math. Need to iron out bugs with motion