Adding force monitoring functions and fixing payload setting bug