PI control mockup based on roll and pitch