CoP and CoG calculations need to be checked