added lwr model
added test simulation with lwr
added testrobot.m to check the model in v-rep and rbt