Perfect Movement

Created movement based on ray tracing
Cleaned up code