https://5dok.net/document/zlgvevdl-design-contact-controller-applying-notable-surface-aerial-manipulator.html