Minor Fixes. Walks with a reasonable speed now.