Created elevator cost function module.

And created testcode.