ProcessingでSimpleOpenNIを使ってKinectで特定の位置の速度を取りたいと考えています。

http://memorandums.hatenablog.com/entry/2013/05/18/142555
こちらのサイトを参考にしてプログラム開始からの経過時間の差分と特定の位置の差分を使用してコードを書きました。
速度らしきものをとることができたのですが値がどうもおかしいです。思いっきり腕をスイングして時速７キロほどです。つきましては分かる方いましたら、何かアドバイスをいただけると幸いです。(文字の制限上、ソースを入力出来ないのが残念ですが)
なまじ動いてしまうため間違いがどこにあるのか分かりません。
よろしくお願いいたします。