trying to plot the new wished direction of the wheelchair
better colormatrix function implemented, now the circle draw method works