Successful Combined. Not moving yet.
Can turn now.
Changed resolution so that algorithm would take 3 ms to run only.