arduino code with basic packets, only 1 shoulder works with this code