https://xiblog.se/lankar/mekanik/kastroerelsens-ekvationer-2/