Add speed coube
Change calcul of speed