机械手运动仿真实验报告一、机械手结构组成（简图）①为机械手底座②为机械臂1③为机械臂2 ④为机械臂3a、b、c为转动副，机械臂实现3自由度运动二、机械手运动学方程推导绘图框及转动副夹角：绘图框大小为400X400转动副a：anglea转动副b：angleb转动副c：anglec机械手运动范围：机械臂1长度50，机械臂2长度100，机械臂3长度50。

三个关节可实现360度旋转。

故机械臂运动范围为以半径为200的圆内。

机械手底座：X：(150,200)Y：(250,200)机械臂1：X1：(200,200)Y1：((200+ 50 * cos(anglea*3.1415926/180)), (200-50 * sin(anglea*3.1415926/180)))机械臂2：X2：((200+ 50 * cos(anglea*3.1415926/180)), (200-50* sin(anglea*3.1415926/180)))Y2：((200 + 50 * cos(anglea*3.1415926/180)+100 * cos(angleb*3.1415926/180)), (200 - 50 * sin (anglea*3.1415926/180)-100* sin(angleb*3.1415926/180)))机械臂3：X3：((200 + 50 * cos(anglea*3.1415926/180)+100 * cos(angleb*3.1415926/180)), (200 - 50 * sin (angLea*3.1415926/180)-100* sin(angleb*3.1415926/180)))Y3：( (200 + 50 * cos(anglea*3.1415926/180)+100 * cos(angleb*3.1415926/180)+50 * cos(anglec *3.1415926/180)), (200 - 50 * sin(anglea*3.1415926/180)-100* sin(angleb*3.1415926/180)-50 * sin(anglec*3.1415926/180)))三、机械手运动仿真程序编写（关键函数代码）pWnd->Invalidate();pWnd->UpdateWindow() ;pDC->Rectangle(0,0,400,400);DrawRobotBase();DrawRobotMemberBar1(m_fanglea);DrawRobotMemberBar2(m_fanglea, m_fangleb);DrawRobotMemberBar3(m_fanglea, m_fangleb, m_fanglec);//绘制底座及其颜色代码void CDrawRobotDlg::DrawRobotBase(){CPen SuiyiPen;SuiyiPen.CreatePen(PS_SOLID,Wide,RGB(hong, lv, lan));CPen *oldPen;oldPen = pDC->SelectObject(&SuiyiPen);pDC->MoveTo(150,200);pDC->LineTo(250,200);pDC->SelectObject(oldPen);DeleteObject(SuiyiPen) ;}//绘制杆1void CDrawRobotDlg::DrawRobotMemberBar1(float anglea){pDC->MoveTo(200,200);pDC->LineTo(int(200+ 50 * cos(anglea*3.1415926/180)),int(200-50 * sin (anglea*3.1415926/180)));}//绘制杆2void CDrawRobotDlg::DrawRobotMemberBar2(float anglea,float angleb){pDC->MoveTo(int(200+ 50 * cos(anglea*3.1415926/180)),int(200-50* sin (anglea*3.1415926/180)));pDC->LineTo(int(200 + 50 * cos(anglea*3.1415926/180)+100 * cos(angleb *3.1415926/180)),int(200 - 50 * sin(anglea*3.1415926/180)-100* sin(angleb*3.1415926/180)));}//绘制杆3void CDrawRobotDlg::DrawRobotMemberBar3(float anglea, float angleb, float anglec){pDC->MoveTo(int(200 + 50 * cos(anglea*3.1415926/180)+100 * cos(angleb *3.1415926/180)),int(200 - 50 * sin(anglea*3.1415926/180)-100* sin(angleb*3.1415926/180)));pDC->LineTo(int(200 + 50 * cos(anglea*3.1415926/180)+100 * cos(angleb *3.1415926/180)+50 * cos(anglec*3.1415926/180)),int(200 - 50 * sin(anglea*3.1415926/180)-100* sin(angleb*3.1415926/180)-50* sin(anglec*3.1415926 /180)));}//转动副a加减角度按钮代码void CDrawRobotDlg:: OnButton 1(){m_fanglea = m_fanglea + 1 ;UpdateData(FALSE);Invalidate(FALSE) ;}void CDrawRobotDlg::OnButton2(){m_fanglea = m_fanglea - 1 ;UpdateData(FALSE);Invalidate(FALSE) ;}//转动副b加减角度按钮代码void CDrawRobotDlg::OnButton3(){m_fangleb = m_fangleb + 1 ;UpdateData(FALSE);Invalidate(FALSE) ;}void CDrawRobotDlg::OnButton4(){m_fangleb = m_fangleb - 1 ;UpdateData(FALSE);Invalidate(FALSE) ;}//转动副c加减角度按钮代码void CDrawRobotDlg::OnButton5(){m_fanglec = m_fanglec + 1 ;UpdateData(FALSE);Invalidate(FALSE) ;}void CDrawRobotDlg::OnButton6(){m_fanglec = m_fanglec - 1 ;UpdateData(FALSE);Invalidate(FALSE) ;}//机械臂1启动按钮代码void CDrawRobotDlg::OnButton7(){AfxBeginThread(MoveThreada, this) ; }//机械臂2启动按钮代码void CDrawRobotDlg::OnButton8(){AfxBeginThread(MoveThreadb, this) ; }//机械臂3启动按钮代码void CDrawRobotDlg::OnButton9(){AfxBeginThread(MoveThreadc, this) ;}//机械臂1旋转代码UINT CDrawRobotDlg::MoveThreada(void *parama) {CDrawRobotDlg *pDlga = (CDrawRobotDlg*)parama ;while(1){pDlga->m_fanglea = pDlga->m_fanglea + 1 ;pDlga->Invalidate(FALSE) ;Sleep(100) ;}return 0 ;}//机械臂2旋转代码UINT CDrawRobotDlg::MoveThreadb(void *paramb) {CDrawRobotDlg *pDlgb = (CDrawRobotDlg*)paramb ;while(1){pDlgb->m_fangleb = pDlgb->m_fangleb + 1 ;pDlgb->Invalidate(FALSE) ;Sleep(100) ;}return 0 ;}//机械臂3旋转代码UINT CDrawRobotDlg::MoveThreadc(void *paramc) {CDrawRobotDlg *pDlgc = (CDrawRobotDlg*)paramc ;while(1){pDlgc->m_fanglec = pDlgc->m_fanglec + 1 ;pDlgc->Invalidate(FALSE) ;Sleep(100) ;}return 0 ;}。