Question related Servo function

I am attempting to insert the `print6Axis();` function within the servo algorithms. However, I am uncertain about where I should place the command within the servo function, as I am not familiar with the servo function responsible for moving the head or legs.

For instance, let's consider the function called `servomove`. In pseudo-code, the function might resemble the following:

servomove loop{
    targethead.setPWN(70); //Example command. I assume this is how it works, right? 

    if printgyro == 1: // When it received 'V' from a user.
	print6Axis(); // Add the function to prevent it from halt when servo moves
}

I'm trying to insert the `print6Axis();` function in the servo function so that way, it wouldn't stop servo function from printing gyro.

Do you have any idea where I can find it?