https://5dok.org/document/qmj8l065-stigmoberg-onmodelingandcontrolofflexiblemanipulators.html