Souci avec le calcul de 'final_target_vel'

final_target_vel J'ai l'impression qu'il y un soucis non? Avec des paramètre cohérent j'ai toujours une racine d'un nombre négatif et donc ça plante. il n 'y a pas une erreur dans l'équation ?