Added start of elevator go -> C interface and ctrl logic