In der Hauptschleife fehlt etwas in der Art:

motpwm_setLeft(speed_l);
motpwm_setRight(speed_r);