まず計算したのを素直に足して、変な挙動だったら逐次調節すりゃいんじゃね