calc_vels working prototype

Implement full paralellisation of main loop