//Encoder
#include "rskr8c27def.h"
#include "ior8c26_27.h"
#include "digitIO.h"
#define encoder0PinA 15 //INT1
#define encoder0PinB 33 //INT3
#define RawPinA p1_5
#define RawPinB p3_3
int encoder0Pos ;
void encoder_init()
{
//**************************************
// INT1 Interrupt Setting
//**************************************
//Note: Set INT1 hardware interrupt pin to input
//Note: By default, INT1 pin is at P1_7 pin
//To change to INT1 pin at P1_5 pin, set tiosel_traioc=1
//To change to INT1 pin at P3_6 pin, set int1sel=1
int1ic=0x04;
//Set interrupt priority level and active edge(int1ic bit 0, 1, 2 and 4)
int1en=1;
//Input enabled(inten bit 2)
int1pl=1;
//Both edges selected(inten bit 3)
int1f0=1;int1f1=0;
//Filter with f1 sampling selected(intf bit 2 and 3)
tiosel_traioc=1;
//**************************************
// INT3 Interrupt Setting
//**************************************
//Note: Set INT3 hardware interrupt pin to input
int3ic=0x04;
//Set interrupt priority level and active edge(int3ic bit 0, 1, 2 and 4)
int3en=1;
//Input enabled(inten bit 6)
int3pl=1;
//Both edges selected(inten bit 7)
int3f0=1;int3f1=0;
//Filter with f1 sampling selected(intf bit 6 and 7)
encoder0Pos = 0;
}
void encoder_stop()
{
int1en=0;
int3en=0;
}
void encoder_start()
{
int1en=1;
int3en=1;
}
void encoder_reset()
{
encoder0Pos = 0;
}
#pragma vector= INT1
__interrupt void INT1_ISR(void)
{
// look for a low-to-high on channel A
//if (digitalRead(encoder0PinA) == HIGH) {
if (RawPinA == 1) {
if (RawPinB == 0) {
encoder0Pos = encoder0Pos + 1; // CW
}
else {
encoder0Pos = encoder0Pos - 1; // CCW
}
}
else // must be a high-to-low edge on channel A
{
if (RawPinB == 1) {
encoder0Pos = encoder0Pos + 1; // CW
}
else {
encoder0Pos = encoder0Pos - 1; // CCW
}
}
}
我要赚赏金打赏帖 |
|
|---|---|
| 28BYJ-48机械臂实现人脸跟随被打赏¥24元 | |
| 基于RK3506B的片温识读功能的实现被打赏¥25元 | |
| 【瑞萨RA8D1测评】基于FreeRTOS的lvgl移植教程被打赏¥29元 | |
| 电子价签墨水屏开发被打赏¥35元 | |
| 【Ozone】RTT 打印终端使用被打赏¥29元 | |
| BMS保护板绝缘检测功能-不平衡电桥技术绝缘电阻检测设计与实现被打赏¥34元 | |
| 给28BYJ-48三自由度机械臂加一个网页控制台被打赏¥32元 | |
| 用28BYJ-48电机从零搭一台三自由度机械臂被打赏¥33元 | |
| 【英飞凌开发经验】ModusToolbox配置EdgeTalk外设被打赏¥27元 | |
| 基于BQ76952PFBR的BMS保护板热插拔损坏的原因和处理措施被打赏¥32元 | |
我要赚赏金
