Like i said I'm on a tight schedule so i had to rush everything and to answer your question nothing is working at the moment and the reason being that i don't know where to start, got the arm assembled and the chassis built so the hardware part is pretty much taken care of but what remains is the much harder software side of things and like i said the code posted here is the farthest I've been able to get