ManuelW/grbl-LPC-CoreXY
1
0
Fork 0
Code Issues Pull Requests Releases 1 Wiki Activity

Fix current_control

Browse Source
This commit is contained in:
Todd Fleming 2017-01-07 20:12:55 -05:00
parent 3344ff1e74
commit dec344fdb0
1 changed files with 6 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
smoother/current_control.cpp
View File

@ -37,10 +37,16 @@ void current_init()
CURRENT_I2C.Control(ARM_I2C_BUS_SPEED, ARM_I2C_BUS_SPEED_STANDARD); CURRENT_I2C.Control(ARM_I2C_BUS_SPEED, ARM_I2C_BUS_SPEED_STANDARD);
CURRENT_I2C.Control(ARM_I2C_BUS_CLEAR, 0); CURRENT_I2C.Control(ARM_I2C_BUS_CLEAR, 0);
#ifdef CURRENT_MCP44XX_ADDR
uint8_t init1[] = {0x40, 0xff}; uint8_t init1[] = {0x40, 0xff};
uint8_t init2[] = {0xA0, 0xff}; uint8_t init2[] = {0xA0, 0xff};
CURRENT_I2C.MasterTransmit(CURRENT_MCP44XX_ADDR, init1, 2, false); CURRENT_I2C.MasterTransmit(CURRENT_MCP44XX_ADDR, init1, 2, false);
while (CURRENT_I2C.GetStatus().busy)
;
CURRENT_I2C.MasterTransmit(CURRENT_MCP44XX_ADDR, init2, 2, false); CURRENT_I2C.MasterTransmit(CURRENT_MCP44XX_ADDR, init2, 2, false);
while (CURRENT_I2C.GetStatus().busy)
;
#endif
set_current(0, DEFAULT_X_CURRENT); set_current(0, DEFAULT_X_CURRENT);
set_current(1, DEFAULT_Y_CURRENT); set_current(1, DEFAULT_Y_CURRENT);