Added joint orientation calculator