Added function

Added Linear function, which incorporates deadzones and max speed to
make sure that no control is wasted