The surena-v from cast-robotics

surena-v's People

Contributors

Stargazers

surena-v's Issues

project start time does not exits

zinq variable packet size

commented lines when handDeviceID is 4 ~6 are problem because the packet size must be 300.

epos.cpp line 529

inline QByteArray Epos::CreateHandPacket(QList<int> motorPositions)
{

    static int handDeviceID=0;
    QByteArray data;

    if(handDeviceID<4){
        data.append(CreatePDOPacket(0x401+handDeviceID,motorPositions[12+handDeviceID+4],0x3f));
        data.append(CreatePDOPacket(0x401+handDeviceID,motorPositions[12+handDeviceID],0x3f));
        handDeviceID++;
    }
    else if(handDeviceID> 3 && handDeviceID<7)
    {
        // data.append(CreateDynamixelPacket(0x581,handDeviceID-3,motorPositions[12+handDeviceID],100));
        // data.append(CreateDynamixelPacket(0x581,handDeviceID-3,motorPositions[8+12+handDeviceID],100));
        handDeviceID++;
    }
    else if(handDeviceID==7)
    {
        ///right palm
        // data.append(CreatePDOPacket(palmCanID,motorPositions[19] &0xff,0));
        // ///left palm
        // data.append(CreatePDOPacket(palmCanID,motorPositions[27] &0xff,0));
        handDeviceID++;
    }
    else if(handDeviceID==8)//start move into controlworld for hands
    {
        data.append(CreatePDOPacket(0x501,0x0f,0x0f));
        data.append(CreatePDOPacket(0x501,0x0f,0x0f));
        handDeviceID=0;

    }
    return data;
}

Recommend Projects