Поправить программу на C++

Мне нужно поправить программу на C++, программа должна считать углы двойного математического маятника по формуле. Файл с программой предоставлю. По факту нужно добавить формулу