Added speed change for openloop stuff
fixed lambda problem. still have rotation problem