Copter: Add rate constrain and combine limit calc