Method worldToMap

* @brief Tranform from world map(x, y) to costmap(x, y) * @param mx costmap x * @param my costmap y * @param wx world map x * @param wy world map y * @return true if successfull, else false */