implemented position controller in drive.c and created shell to test it.