Robot did not assemble total stiffness matrix correctly, please note element connectivity from the diagram is $1$:$1,2,3$

$2$:$3,4$

$3$:$2,5$

$4$:$4,5,6$