fixed enterthematrix.c

fixed compile and motor issues