Found few bugs in my program when i enabled input parameters. BEfore I had it set to a constant for ease. Once i changed the inputs, the Eulers method seemed to perform better than heun, which shouldnt be the case. I managed to find a bug in my Heun function(acceleration wasnt being updated in each turn), and now it works fine.