node to publish COG/ZMP

edit

I just published hrl_kinematics which consists of a small library and a node to do exactly that. From a URDF with joint state, you can compute the CoG and a projection to the supporting plane. You can also specify the supporting links (feet) and check of the pose is statically stable. There is not much documentation on the wiki, but the code is pretty self-explanatory I would say.

There's no ZMP in there yet -- I would happily accept patches!