implement basic functions
Java Map&HashMap replaced with own struct
Java PrioQ replaced with own struct