WavDemo working (upgraded robot)