constant force implementation

Hi Juanjo, I added a constant force function. Could you please merge it?

Signed-off-by: koutrasc koutrasc@outlook.com