Nur mal so als anmerkung: Ich baue zur zeit auch n roboter, allerdings auf zwei bein basis mit 4 freiheitsgraden pro bein. Um festzustellen ob sich ein bein am boden befindet oder nicht benutze ich zwei drucksensoren funzt bei mir relativ gut.