Moved processing into separate function

Make custom functions private, process data on pose change.