Reformat
Add some parameters to motorcontrol
Don't shrink the vector at keyboard