Walk cycle and straight walk test.

I based the walk cycle test on a model walk and the straight walk on a "normal" walk. It still needs some work but so far i'm pretty happy.