Merge motor_controller3 to pidwallfollow form develop