[godobject] does iteratevely updating godobject based on perpendicular vector of edge work?

[JotaroS]

question

I see that in the code it's iteratevely calculating next new godobject position by using two normal vector of concave corner. This will work when corner is acute, but not when corner is shallow. I'm looking at this line:

https://github.com/HassoPlattnerInstituteHCI/dualpantoframework/blob/ad2554ed3f1aa7e95d1c3788c1c52e0f5ddf7641/firmware/src/physics/godObject.cpp#L152-L174

here's how it won't work. maybe @lukaswagner can point me out if i'm right or not?

possible solution

• maybe use lagrangian multiplier (constrained based method on IROS95 http://robotics.stanford.edu/~jks/pubs/1995-Zilles-god-object-iros.pdf )