static struct device_t * clk_mux_probe(struct driver_t * drv, struct dtnode_t * n) { struct clk_mux_pdata_t * pdat; struct clk_mux_parent_t * parent; struct clk_t * clk; struct device_t * dev; struct dtnode_t o; virtual_addr_t virt = phys_to_virt(dt_read_address(n)); char * name = dt_read_string(n, "name", NULL); int nparent = dt_read_array_length(n, "parent"); int shift = dt_read_int(n, "shift", -1); int width = dt_read_int(n, "width", -1); int i; if(!name || (nparent <= 0) || (shift < 0) || (width <= 0)) return NULL; if(search_clk(name)) return NULL; pdat = malloc(sizeof(struct clk_mux_pdata_t)); if(!pdat) return NULL; parent = malloc(sizeof(struct clk_mux_parent_t) * nparent); if(!parent) { free(pdat); return NULL; } clk = malloc(sizeof(struct clk_t)); if(!clk) { free(pdat); free(parent); return NULL; } for(i = 0; i < nparent; i++) { dt_read_array_object(n, "parent", i, &o); parent[i].name = strdup(dt_read_string(&o, "name", NULL)); parent[i].value = dt_read_int(&o, "value", 0); } pdat->virt = virt; pdat->parent = parent; pdat->nparent = nparent; pdat->shift = shift; pdat->width = width; clk->name = strdup(name); clk->count = 0; clk->set_parent = clk_mux_set_parent; clk->get_parent = clk_mux_get_parent; clk->set_enable = clk_mux_set_enable; clk->get_enable = clk_mux_get_enable; clk->set_rate = clk_mux_set_rate; clk->get_rate = clk_mux_get_rate; clk->priv = pdat; if(!register_clk(&dev, clk)) { for(i = 0; i < pdat->nparent; i++) free(pdat->parent[i].name); free(pdat->parent); free(clk->name); free(clk->priv); free(clk); return NULL; } dev->driver = drv; if(dt_read_object(n, "default", &o)) { char * c = clk->name; char * p; u64_t r; int e; if((p = dt_read_string(&o, "parent", NULL)) && search_clk(p)) clk_set_parent(c, p); if((r = (u64_t)dt_read_long(&o, "rate", 0)) > 0) clk_set_rate(c, r); if((e = dt_read_bool(&o, "enable", -1)) != -1) { if(e > 0) clk_enable(c); else clk_disable(c); } } return dev; }
static struct device_t * clk_rk3128_gate_probe(struct driver_t * drv, struct dtnode_t * n) { struct clk_rk3128_gate_pdata_t * pdat; struct clk_t * clk; struct device_t * dev; struct dtnode_t o; virtual_addr_t virt = phys_to_virt(dt_read_address(n)); char * parent = dt_read_string(n, "parent", NULL); char * name = dt_read_string(n, "name", NULL); int shift = dt_read_int(n, "shift", -1); if(!parent || !name || (shift < 0)) return NULL; if(!search_clk(parent) || search_clk(name)) return NULL; pdat = malloc(sizeof(struct clk_rk3128_gate_pdata_t)); if(!pdat) return NULL; clk = malloc(sizeof(struct clk_t)); if(!clk) { free(pdat); return NULL; } pdat->virt = virt; pdat->parent = strdup(parent); pdat->shift = shift; pdat->invert = dt_read_bool(n, "invert", 0); clk->name = strdup(name); clk->count = 0; clk->set_parent = clk_rk3128_gate_set_parent; clk->get_parent = clk_rk3128_gate_get_parent; clk->set_enable = clk_rk3128_gate_set_enable; clk->get_enable = clk_rk3128_gate_get_enable; clk->set_rate = clk_rk3128_gate_set_rate; clk->get_rate = clk_rk3128_gate_get_rate; clk->priv = pdat; if(!register_clk(&dev, clk)) { free(pdat->parent); free(clk->name); free(clk->priv); free(clk); return NULL; } dev->driver = drv; if(dt_read_object(n, "default", &o)) { char * c = clk->name; char * p; u64_t r; int e; if((p = dt_read_string(&o, "parent", NULL)) && search_clk(p)) clk_set_parent(c, p); if((r = (u64_t)dt_read_long(&o, "rate", 0)) > 0) clk_set_rate(c, r); if((e = dt_read_bool(&o, "enable", -1)) != -1) { if(e > 0) clk_enable(c); else clk_disable(c); } } return dev; }